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ABSTRACT 

The  calibration  problem  of  a  Short  Baseline  Underwater 
Vehicle  Tracking  Range  is  concerned  largely  with  the  coherency 
of  path  as  the  target  vehicle  passes  from  the  domain  of  one 
array  into  that  of  another.  The  arrays  are  placed 
approximately  in  a  hexagonal  mesh.  Thus  there  are  regular 
locations  (triple  overlap  regions)  where  the  vehicle  is 
tracked  simultaneously  by  three  separate  arrays.  Longbase 
methods  can  be  used  to  locate  the  vehicle  in  these  isolated 
regions.  Presumably  the  four  determinations  (three  for  the 
individual  short  baseline  arrays  and  one  for  the  long 
baseline)  can  be  used  to  locate  the  arrays  and  help  calibrate 
the  range. 

This  thesis  contains  a  feasibility  study  for  this  idea. 
Vehicles  are  placed  at  known  locations  in  the  triple  overlap 
regions.  A  sequence  of  correction  actions  is  postulated  and 
the  algorithms  have  been  programmed.  It  appears  to  work  quite 
well  within  the  confines  of  this  idealized  study. 
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available,  to  ensure  that  the  programs  are  free  of  computational 
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I .     INTRODUCTION 

The  Naval  Undersea  Weapons  Engineering  Station  (NUWES) 
currently  operates  nine  test  ranges  for  the  purpose  of  testing 
and  analyzing  the  performance  of  torpedoes.  These  ranges 
provide  a  three-dimensional  track  of  torpedoes  (or  other  water 
borne  vehicles)  from  acoustic  information  received  by  bottom 
based  sensor  arrays.  This  thesis  supports  ongoing  research 
conducted  by  Professor  Robert  R.  Read  of  the  U.  S.  Naval 
Postgraduate  School,  whose  goal  is  to  monitor  the  calibration 
of  these  ranges. 

The  focus  of  this  thesis  is  to  support  range  calibration, 
specifically,  by  investigating  sensor  location  error  (position 
and  orientation)  using  raw  tracking  data  provided  by  the  range 
itself.  Since  the  sensors  are  inaccessible  on  the  ocean 
floor,  their  exact  locations  are  in  doubt  and  estimated  by  a 
range  survey  procedure.  The  survey  is  costly  and  takes  an 
entire  day  for  a  single  sensor  array,  requiring  that  the  range 
be  shutdown,  thus  losing  valuable  testing  time.  This 
OPERATIONAL  estimate  of  sensor  location  is  subject  to  error 
and  may  differ  from  its  ACTUAL  location.  Successive  resurveys 
of  sensor  arrays  find  the  array  locations  moved  by  as  much  as 
tens  of  feet. 

A  difficulty  in  using  the  range,  is  that  two  or  more 
versions  of  a  torpedo  track  can  be  provided  by  adjacent 


sensing  arrays.  These  differing  versions  of  track  manifest 
themselves  as  the  torpedo  traverses  areas  of  mutual  sensor 
monitoring  (overlap  regions) .  Accurate  study  of  torpedo 
performance  becomes  difficult  when  considering  the  joint 
behavior  of  several  vehicles  (e.g.  a  submarine  and  torpedo). 

The  calibration  support  methodology  developed  in  this 
paper  will  focus  on  treating  the  location  of  those  sensing 
arrays  that  are  interior  to  the  others  (see  Figure  3) .  The 
results  will  be  a  set  of  decision  rules  for  the  iterative 
correction  of  the  interior  sensors  location.  Appendix  I 
contains  a  mathematical  formulation  of  the  problem  and 
explains  the  choice  of  algorithm  made.  In  the  context 
presented  here,  this  methodology  works  quite  well. 

The  organization  of  the  thesis  is  as  follows: 
Chapter  II  contains  explicit  background  of  the  range  setup  and 
operation  along  with  a  description  of  locational  errors. 
Chapter  III  contains  the  error  correction  methodology 
developed  to  solve  for  sensor  locational  errors.  Specific 
assumptions  are  included  here  for  this  problem.  Chapter  IV 
integrates  other  sensors  into  the  correction  methodology  and 
relaxes  the  initial  assumption  made  in  the  solution 
formulation.  Chapter  V  reports  on  the  conclusions  reached  and 
recommendations  for  further  work  in  this  area. 


II.   BACKGROUND 

A.   RANGE  CONSTRUCTION  AND  OPERATION 

References  1-6  outline  previous  work  done  in  support  of 
this  project.  This  thesis,  as  with  previous  works,  will 
utilize  data  from  the  Nanoose  range. 

The  Nanoose  underwater  tracking  range  consists  of  a  number 
of  sensing  arrays  of  the  short  baseline  (SBL)  type  positioned 
on  the  ocean  bottom.  Each  array  is  three  dimensional  and 
contains  four  hydrophones  (see  Figure  1) . 


SCHEMATIC  DIAGRAM  OF  3-D 
SENSOR  ARRAY 
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ACOUSTIC 
CENTER 


Figure   1.    SBL  Sensor  Array. 


The  acoustic  center  is  the  geometric  center  of  the  box  formed 
by  the  arms  of  the  sensor  array  and  is  used  as  the  sensor 
array's  location.  The  30  foot  sensor  arms  are  short  in 
comparison  to  the  target  tracking  distances,  thus  the  name 
"short  baseline"  (SBL) . 

Targets  on  the  range  are  tracked  in  the  following  manner. 
The  targets  (e.g.  torpedoes)  are  fitted  with  acoustic 
transmitters  (pingers)  which  emit  sound  pulses  at  precisely 
timed  intervals.  The  pingers  and  sensor  arrays,  are 
synchronized  with  the  shore  based  clock.  When  an  array 
detects  an  acoustic  pulse,  the  transit  times  of  the  sound 
wave,  from  the  target  to  the  sensor  array,  are  computed. 

A  unique  relative  target  position  location  (posloc)  is 
found  using  the  transit  times  measured  from  the  target  pinger 
to  the  four  sensor  hydrophones.  The  individual  sound  pulses 
are  coded  for  the  purpose  of  distinguishability .  Figure  2 
shows  a  sensor  array  interacting  with  various  target  vehicles. 

A  technique  known  as  ray  tracing  is  used  to  determine 
location.  A  ray  is  the  normal  to  the  acoustic  wave  front. 
Based  on  Snell's  Law  [Ref.7],  ray  tracing  reconstructs  the  ray 
path  traveled  by  sound  in  water.  The  differential  of  pulse 
arrival  times  at  the  four  hydrophones  are  used  to  construct 
the  ray's  azimuth  and  elevation  angles  at  the  array's 
location.  These  are  used  to  initialize  the  ray  tracing 
algorithm.  The  computation  works  its  way  back  to  the  sound 
source  and  the  algorithm  is  stopped  when  the  transit  time  is 
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Figure  2.  SBL  Sensor  and  Ray  Paths 


'used  up'.   The  result  is  a  posloc  for  the  target  at  the  time 
of  the  ping. 

Reconstruction  of  the  target  local  track  is  accomplished 
by  joining  the  SBL  poslocs  of  each  array  over  time.  This 
produces  a  relative  or  apparent  target  track  from  each  sensor. 
Connecting  these  relative  tracks  gives  a  target  track 
throughout  the  range.  The  use  of  many  sensor  arrays  (Figure 
3),  enables  continuous  monitoring  of  the  entire  range.  Each 
array  monitors  a  finite  volume  of  water,  limited  by  both 
acoustical  attenuation  and  time  gating.  Careful  arrangement 
of  the  sensor  arrays  enables  full  coverage  without  excessively 
sized  overlap  regions.  These  overlap  regions  are  necessary  to 
ensure  track  continuity  throughout  the  range. 

There  are  two  types  of  overlap  regions,  double  and  triple. 
The  names  correspond  to  the  numbers  of  arrays  which  serve 
each,  two  or  three  respectively.  An  example  of  a  torpedo 
traversing  a  double  overlap  region  is  presented  in  Figure  4. 
This  shows  an  ideally  continuous,  or  coherently  connected, 
track  as  the  torpedo  crosses  from  one  sensor  region  to 
another. 

B.   POSLOC  ERRORS 

The  track  versions  generated  by  the  individual  sensors  are 
rarely  connected  as  the  target  crosses  these  overlap  regions. 
Separations  in  track  are  commonly  on  the  order  of  40-50  feet 
(slant  range) . 


Figure  3 .  Nanoose  Range 


SENSOR   ARRAY   CROSSOVER   REGIONS 


NOT    TRACKED 

—  -  SINGLE     COVERAGE 

—  DOUBLE     COVERAGE 


Figure  4.  Torpedo  Track  Through  a  Double  Overlap  Region 
(no  sensor  displacement  errors) . 


The  causes  of  these  discontinuities  can  be  grouped  into  3 
general  categories: 

1)  Water  Condition  Errors/Ray  tracing 

Reference  1  contains  an  analysis  of  this  problem. 

2)  Pinger  Timing  Errors  (Offset  and  Synchronization) 

Reference  2  details  work  done  in  this  area. 

3)  Sensor  Location  Errors  (Position  and  Orientation) 

References  3-6  contain  previous  work  done  in  this 

area.   This  thesis  continues  this  work. 

Examination  of  the  current  ray  tracing  initialization 

method,  shows  that  it  can  contribute  up  to  1/3  of  the  total 

target   positional   errors.     A   recommended   method   of 
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initialization  presented  in  Appendix  F,  reference  1, 
significantly  reduces  the  errors  caused  by  the  current  ray 
trace  initialization  method. 

The  remaining  significant  errors  are  believed  to  be 
attributed  to  water  column  and  sensor  locational  errors.  In 
the  water  column,  two  effects  come  into  play.  First,  the 
horizontal  non  homogeneity  of  the  water  causes  the  ray  paths 
to  become  kinked.  The  second  effect  is  the  limited  depth  to 
which  the  depth  velocity  profile  (DVP)  is  measured.  The  range 
obtains  but  one  DVP  measurement  per  day  (due  to  cost  and 
eguipment  constraints)  and  to  a  depth  generally  shallower  than 
the  deeper  sensor  hydrophones.  Extrapolation  of  the  DVP  is 
required  if  a  sensor  hydrophone  is  deeper  than  the  level 
provided  by  the  measured  profile.  Uncorrected  for,  these 
effects  can  cause  large  posloc  displacements. 

The  location  errors  of  the  sensors  lend  themselves  to 
relatively  simple  analyses  and  are  discussed  below. 

A  number  of  other  systematic  error  sources  are  present 
(e.g.  bottom  currents,  curvature  of  the  earth) ,  but  their 
effects  are  of  much  smaller  magnitude.  For  the  present  they 
are  ignored. 

C.   LOCATIONAL  ERRORS 

A  sensor  location  comprises  six  components.  These  are 
the  x,  y,  and  z  position  of  the  sensors  acoustic  center  (in 
the  range  coordinate  system) ,  and  the  xtilt,  ytilt,  and  zrot 


angular  orientation  of  each  array  axis  from  the  range 
coordinate  axis.  The  tilt  angles  are  measured  to  the  sensor's 
arms  from  the  horizontal.  The  zrot  component  measures  the  CCW 
rotation  of  the  sensor  from  east  (zrot=0  implies  the  x-arm  is 
pointed  east) .  The  xtilt,  ytilt  and  zrot  can  be  thought  of  in 
terms  of  roll,  pitch  and  yaw  ,  respectively.  The  x,  y,  z,  and 
zrot  terms  are  measured  during  the  sensor  survey.  Such  a 
survey  locates  the  acoustical  center  of  the  array  with  respect 
to  the  range  coordinate  system.  When  this  is  combined  with 
the  tilt  angles  obtained  from  the  sensor's  x  and  y  arms  the 
array's  OPERATIONAL  location  is  determined. 
The  following  terms  are  defined: 

-  OPERATIONAL  location  -  the  position  and  orientation  of 
the  sensor  array  as  determined  by  survey  technigues. 

-  ACTUAL  location  -  the  true  position  and  orientation  of 
the  sensor  array. 

Surveyed  positions  will  suffer  from  the  category  1  errors, 
water  column  nonhomogeneity  and  ray  tracing.  Another  possible 
cause  for  the  deviations  from  previous  OPERATIONAL  locations 
(survey  to  survey)  can  be  due  to  physical  array  shifts  on  the 
ocean  floor.  If  such  shifts  actually  do  occur,  previous 
locational  data  is  invalidated.  Thus  range  monitoring  must  be 
performed  continuously. 

The  last  two  components  of  the  sensors  location,  xtilt  and 
ytilt,  can  differ  from  the  ACTUAL  tilts  due  to  inaccuracies  of 
the  indicators  in  the  arms  of  the  sensors. 
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It  is  easy  to  visualize  in  the  two  dimensional  case  the 
effect  on  the  posloc  from  errors  in  the  six  components  of  the 
sensor  location.  A  situation  similar  to  that  depicted  in 
Figure  5  occurs  if  we  confine  the  location  errors  to  just  x, 
y  and  rotational  offsets.  This  is  attributed  to  a  shift  in 
the  local  coordinate  system  of  the  sensor  from  which  the 
poslocs  are  found.  Posloc  errors  are  less  direct  for  errors 
in  the  z  direction.  Not  only  is  there  a  change  in  the  depth 
of  the  local  coordinate  system,  but  also  in  the  water 
environment.  As  the  sensor  is  'displaced'  in  depth,  the  sound 
velocity  at  the   new   level   of   the  hydrophones  will   be 


SENSOR  ARRAY  CROSSOVER  REGION  WITH  SHIFTED  SENSORS 


TRUE  TORPEDO  TRACK 

TORPEDO  TRACK  AS  SEEN  FROM  A*  RELATIVE  POSITION 

TORPEDO  TRACK  AS  SEEN  FROM  B'»  RELATIVE  POSmON 

+        TRUE  POSITION  OF  SENSORS  A  and  B 
^         ASSUMED  or  RELATIVE  POSITION  of  SENSORS 


Figure  5.  True  and  observed  Torpedo  Track  as  seen  by 

displaced  sensors. 
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different.  This  changes  the  ray  paths  of  the  sound  pulses  and 
causes  a  disproportional  change  in  the  target  posloc  direction 
vector. 

For  an  example  of  the  size  of  the  errors  produced  from 
deviations  in  the  six  locational  components,  consider  a  0.5° 
tilt  error  (xtilt  or  ytilt)  .  This  will  cause  a  SBL  posloc 
displacement  of  40  feet  at  a  4000  foot  range.  This  is  a 
typical  value  of  interest  in  an  overlap  region. 
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III.   METHODOLOGY 

The  adjustments  to  the  OPERATIONAL  location  of  SBL  sensing 
arrays,  will  be  first  to  the  interior  arrays.  Interior  arrays 
are  those  sensor  arrays  which  have  triple  overlap  with  six 
adjacent,  or  satellite,  sensor  arrays  (see  Figure  3) . 

A.   ERROR  ANALYSIS 

Figure  6  contains  a  schematic  diagram  depicting  the  triple 
overlap  regions  which  provide  information  to  the  interior 
array.  A  triple  overlap  region  (henceforth  referred  to  as  a 
region) ,  represents  a  volume  of  water  monitored,  or  served,  by 
three  independent  sensor  arrays;  in  the  present  case  the 
specified  interior  array  and  two  satellite  arrays.  Three 
independent  poslocs  will  be  generated  for  a  given  acoustic 
'ping'.  In  actuality  these  three  poslocs  will  rarely  be 
coincident.  Their  determination  will  be  influenced  by  the 
error  sources  mentioned  previously. 

1.   Consensus  Location  (LONGBASE) 

The  SBL  poslocs  are  evaluated  upon  comparison  with  a 
consensus  location.  The  choices  for  this  location  are  one,  or 
both  of  the  other  satellite  poslocs,  or  some  aggregate 
location  of  the  three  individual  poslocs.  Professor  Read 
developed  an  algorithm  which,  assuming  that  the  sensor  arrays 
that  service  a  region  are  positionally  correct  (x,  y,  and  z) , 
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Figure  6.  Interior  Array  and  its  Triple  Overlap  Regions 


14 


adjusts  the  azimuth  and  elevation  angles  (associated  with  each 
of  the  three  arrays)  so  that  the  three  poslocs  coincide  [Ref. 
3].  This  method,  long  baseline  (LBL),  uses  the  transit  time 
information  from  the  C-  hydrophones  of  the  three  sensor  arrays 
in  a  region.  In  this  way  a  'new  coordinate'  system  from  these 
hydrophones  is  formed.  Since  the  'arms'  of  this  newly  formed 
surrogate  array  are  long  in  comparison  to  the  distance  to  the 
target,  this  is  termed  "long  baseline". 

Initially  the  transit  times  from  each  array  are  converted 
into  the  three  SBL  poslocs,  which  are  not  coincident.  Each 
posloc  falls  on  the  surface  of  a  'sphere*  described  by  varying 
the  azimuth  and  elevation  angles  for  a  fixed  transit  time. 
Each  of  the  three  arrays  produces  this  'spherical'  surface  and 
they  intersect  at  a  single  point.  This  point  may  be  located 
either  upward  or  downward  in  depth,  and  perhaps  at  a  different 
angular  location  than  the  SBL  poslocs. 

Since  no  sensor  positional  errors  are  assumed  in  longbase, 
a  problem  develops  in  that  the  depth  of  the  LBL  posloc  may  be 
'forced'  from  the  averaged  depth  of  the  SBL  poslocs.  This  may 
or  may  not  move  it  closer  to  the  true  depth.  As  the  longbase 
algorithm  determines  the  depth  of  this  consensus  point,  the 
horizontal  position  is  also,  updated  to  maintain  constant 
transit  times.  This  program  is  the  main  tool  exploited  in  our 
developments.  The  exploitation  of  this  program  will  be 
described  subsequently. 
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2.   Consistency  Of  Errors 

A  formulation  of  the  problem  and  reasons  for  the  choice  of 
a  coordinate  descent  algorithm  are  found  in  Appendix  I.  Once 
a  consensus  location  for  the  target  is  found  (LBL  posloc) ,  an 
error  table  can  be  made  for  the  specified  interior  array. 
This  table  will  consist  of  the  differences  between  the  LBL  and 
SBL  poslocs  and  contains  the  following  locational  attributes: 
elevation  angle,  azimuth  angle,  horizontal  range,  x,  y,  and  z 
coordinates.  Note  that  redundant  information  is  supplied. 
The  azimuth,  elevation  angles  and  horizontal  range,  can  be 
converted  to  x,  y  and  z  coordinates. 

To  describe  the  exploitation  of  the  LBL  algorithm, 
consider  an  interior  array  which  contains  six  regions. 
Suppose  that  the  OPERATIONAL  and  ACTUAL  location  of  the  six 
satellite  arrays  are  the  same,  but  not  so  for  the  interior 
array.  Then  the  poslocs  produced  by  longbase  will  provide 
information  about  the  location  of  the  interior  array.  (It  has 
been  verified  that  for  three  coincident  poslocs,  the  LBL 
posloc  generated  will  fall  on  that  coincident  point.) 

Figure  7  illustrates  an  interior  array  and  two  of  its 
regions  along  with  the  LBL  and  SBL  poslocs  in  two  dimensions. 
Expanded  views  of  the  two  regions  are  shown  in  the  wings.  One 
can  perceive  a  correction  to  the  right  and  upwards.  Next 
consider  six  satellite  regions.  One  can  imagine  a  consistency 
in  the  offset  and  rotational  nature  of  the  x  and  y  errors. 
Heuristically ,  the  optimal  location  for  the  interior  array  can 
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Figure  7.  Consistency  of  Errors  for  Interior  Array  in  Two 
Triple  Overlap  Regions. 
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be  found  by  correcting  one  'error'  at  a  time. 

B.  ASSUMPTIONS 

The  following  assumptions  are  made  in  order  to  develop  a 
prioritized  set  of  corrections  for  the  selected  interior 
sensing  array. 

1)  SATELLITE  SENSORS  ARE  ERROR  FREE 

This  assumption  will  allow  full  concentration  on  the 
posloc  errors  produced  by  the  center  array,  without 
interference  from  noise  in  the  locations  of  the  satellite 
arrays . 

2)  HOMOGENEOUS  ISOSPEED  WATER  COLUMN  (DVP) 

The  advantage  to  making  this  assumption  is  that  of 
simplification  and  the  elimination  of  the  errors  produced  in 
generating  the  SBL  poslocs  using  the  current  algorithms.  This 
simplifies  the  development  of  the  error  correction  priorities. 
Posloc  positional  errors  are  now  isolated  to  sensor  array 
locational  errors. 

C.  TERMINOLOGY 

The  following  terminology  is  used  throughout  the  paper  and 

in  the  FORTRAN  programs. 

For  sensor  number  k,  and  overlap  region  j  ( j=l  to  6) : 

{Xkl}  position  of  the  acoustic  center  of  sensor 
array  k,  for  i=l-3  (x,  y,  and  z)  in  the  Range 
coordinates  (depth  positive  downward) 
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{Aki}  angular  orientation  of  sensor  array  k  for  i= 
1-3  (xtilt,  ytilt,  and  zrot) .  xtilt  and  ytilt 
measured  from  the  horizontal,  zrot  measured 
CCW  from  the  Range  centerline 

{ERROR^}  induced  (known)  locational  error  to  sensor 
array  k,  for  i=l-6  (x,  y,  z,  xtilt,  ytilt,  and 
zrot) 

{SHIFTki}  corrections  made  to  sensor  array  k's  location 
for  i=l-6  (x,  y,  z,  xtilt,  ytilt,  and  zrot) 

{TIMEkji}  acoustic  ping  transit  time  from  the  target  to 
sensor  k's  hydrophones  i=l-4  (x,  y,  z,  and  c) 
in  region  j 

{XSkJ1}  SBL  posloc  position  for  sensor  k  in  region  j 
for  i=l-3  (x,  y,  and  z)  in  the  Range 
coordinates 

{XL^jj}  LBL  posloc  position  for  sensor  k  in  region  j 
for  i=l-3  (x,  y,  and  z)  in  the  Range 
coordinates 

{PHSkj}  azimuth  angle  (CCW  from  east)  to  sensor  k's 
SBL  posloc  in  region  j  from  the  c  hydrophone 

{PHL^}  azimuth  angle  (CCW  from  east)  to  sensor  k's 
LBL  posloc  in  region  j  from  the  c  hydrophone 

{THSkj}     elevation  angle,  from  horizontal,  to 

sensor  k's  SBL  posloc  in  region  j  from  the  c 
hydrophone 

{THI^j}  elevation  angle,  from  horizontal,  to  sensor 
k's  LBL  posloc  in  region  j  from  the  c 
hydrophone 

{HSkj}  horizontal  range  from  sensor  k's  c  hydrophone 
to  region  j's  SBL  posloc 

{HI^j}  horizontal  range  from  sensor  k's  c  hydrophone 
to  region  j's  LBL  posloc 


Utilizing  the  above  definitions,  we  have  for  sensor  array  k: 
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ACTUAL  LOCATION:        {Xkl   Xk2   Xk  3   Ak ,   Ak2   Ak3} 

OPERATIONAL  LOCATION:  {  (Xk  ,+ERROI^  J  (Xk  2+ERRORj.  2)  (Xk  3+ERRORk3) 

(A^  ^ERROR^'  (A^+ERROR^j  (Ak3+ERRORk  6)  } 

Solving  for  {SHIFTki},  the  ACTUAL  location  of  the  sensor  array 

will  be  obtained  as  such: 


Xki  =  (Xkl+ERRORkl 

xk2  =  (Xk'2+ERRORk'2 

xk3  =  (Xk'j+ERRORi.^ 

AkJ  =  (AkJ+ERRORM 

Ak2  =  (Ak2+ERRORk5 

Au  =  (Ak;3+ERRORk;6 


+  SHIFTkl 

+  SHIFTk'2 

+  SHIFTk'3 

+  SHIFTk4 

+  SHIFTk'5 

+  SHIFTk'6 


D.   SETUP  OF  TEST  CONDITIONS  (SIMSTRT,  SETUP) 

First  values  of  the  {ERRORki}  vector  defined  above  are 
prescribed  for  each  sensor  array  k,  in  order  to  generate  the 
OPERATIONAL  locations.  Next  the  DVP  to  be  used  is  selected. 
This  DVP  will  be  4880  ft/sec  and  extend  to  a  depth  exceeding 
the  deepest  hydrophone  in  order  to  eliminate  the  need  for  DVP 
extrapolation.  The  starting  points  for  our  'pseudo  target' 
are  arbitrarily  chosen  to  be  in  the  center  of  each  triple 
overlap  region  j,  at  a  depth  of  400  ft.  The  transit  times 
{TIMEkj,},  i=l-4,  of  acoustic  pings  are  then  generated  from 
these  starting  points  to  the  ACTUAL  array  locations.  The  are 
times  derived  using  the  RAYFIT  program  [Ref.  1],  are  analogous 
to  the  times  provided  by  the  range. 

With  the  transit  times  and'  the  OPERATIONAL  location  of  the 
sensor  arrays,  SBL  poslocs  are  generated  through  ray  tracing. 
These  SBL  poslocs  are  the  sensors  perceived  target  position. 
The  three  poslocs  in  each  region  are  then  used  to  generate  the 
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LBL  poslocs.  An  error  table  for  each  sensor  array  is  then 
formed  using  the  LBL  and  SBL  poslocs.  This  table  contains  the 
following  LBL-SBL  posloc  difference  information  for  sensor  k 
and  region  j : 


THERkj  =  THI^j  -  THSkJ,  elevation  angle  differences 
PHERkj  =  PHI^j  -  PHSkj/  azimuth  angle  differences 
HERkj   =   HI^j  -   HSkJ/  horizontal  range  differences 
XERkj   =  XL^j!  -  XSkjl,  x  coordinate  differences 
YER^   =  XI^jj  -  XSkj2,  Y  coordinate  differences 
ZERtj  =  XL^  -  XSkj3,  z  coordinate  (depth)  differences. 


E.   ERROR  FIXING  (ERRFIX) 
1.   Measure  of  Error 

The  goal  is  to  minimize  separation  between  the  LBL 
poslocs  and  the  interior  arrays  SBL  poslocs  in  each  region. 
A  measure  of  error  to  gauge  success  is  the  three  dimensional 
distance  between  the  two  poslocs: 

d  =  JxER2  +  YER2+ZER2. 

Instead  of  this  we  will  use  an  approximate  equivalent  measure 
developed  by  Professor  Read  in  reference  1: 


d  =  \JZER2  +HER2  +  ( HLxPHER ) 2     . 

This  measure  of  error  contains  the  horizontal  separation 
distance  (HER2  =  XER2  +  YER2)  ,  and  an  additional  term  to 
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account  for  azimuthal  errors.  It's  use  circumvents  the  need 
for  transforming  spherical  coordinates  to  cartesian 
coordinates. 

The  total  measure  of  error  for  a  sensor  array,  will  be  the 
above  measure  averaged  over  the  sensor's  regions. 
2.   Individual  Error  Corrections 

Error  corrections  can  be  thought  of  in  four  distinct 
phases:  Azimuth,  Depth  (Z)  by  Elevation  Angle,  Tilt  Angles 
(xtilt  and  ytilt)  ,  and  coordinates  (X,  Y,  and  Z)  .  This 
section  examines  individual  locational  error  corrections. 
These  individual  error  components  are  treated  in  isolation  of 
the  other  locational  errors  that  may  exist  for  the  sensor 
array.  The  next  section  will  look  at  how  to  combine  these 
error  correction  components  into  a  integrated  correction 
scheme  to  solve  for  array  location. 

The  component  error  corrections  will  be  based  on  the 
average  value  of  the  individual  errors  of  interest.  The  use 
of  averaged  error  allows  the  optimal  sensor  location  to  be 
approached  without  excessive  correction  overshoot. 

Although  an  isospeed  DVP  is  used,  the  algorithms  will 
be  written  generally  so  as  to  facilitate  the  transition  into 
a  gradient  environment.  A  correction  scheme  for  each  error 
independent  of  the  others  will  be  looked  at  first.  A  method 
to  combine  these  into  a  correction  algorithm  will  then  be 
introduced. 
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a.  Azimuth  Errors 

An  azimuth  error  (rotational  error) ,  of  the 
interior  array  will  manifest  itself  in  each  region  regardless 
of  the  water  environment.  Due  to  the  ranges  to  the  triple 
overlap  regions,  small  azimuth  errors  will  cause  large  posloc 
separations.  Since  these  errors  are  easy  to  spot  and  their 
correction  greatly  minimizes  posloc  separation,  an  attempt 
will  be  made  to  correct  these  first. 

The  errors  due  to  azimuth  will  be  of  similar 
magnitudes  in  each  region,  but  most  importantly,  of  the  same 
(consistent)  sign.  The  magnitude  of  these  errors  in  each 
region  can  be  masked  by  even  moderate  x  and  y  coordinate 
displacements  of  the  interior  sensor.  In  correcting  for  this 
azimuth  error  the  average  azimuth  error  over  the  regions  is 
used  as  an  initial  guess.  This  first  guess  will  generally  be 
smaller  in  magnitude  than  the  true  azimuth  error. 

b.  Depth  by  Elevation  Angle 

Once  again  consistency  in  the  signs  of  the 
elevation  angles  is  sought.  Elevation  angles  of  the  same  sign 
can  be  caused  by  a  depth  error  to  the  interior  array.  As 
above  for  the  azimuth  errors,  a  depth  correction  can  be  made 
if  the  elevation  angles  possess  the  same  sign.  The  magnitude 
of  the  correction  will  again  be  based  on  the  average  of  the 
depth  errors.  Correction  of  this  angular  error  using  depth, 
vice  a  function  of  the  elevation  angles  was  chosen  for 
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simplicity.  Correcting  for  depth  errors  in  this  way  also  has 
the  coincident  benefit  of  correcting  for  elevation  angle 
errors. 

In  the  isospeed  environment,  longbase  is  biased 
toward  the  error  free  (correct)  satellite  poslocs.  A  depth 
error  to  the  interior  array  also  correlates  directly  to  a 
depth  shift  in  its  SBL  posloc.  This  results  because  the  SBL 
posloc  direction  vector  is  not  effected  by  the  depth  change  in 
the  isospeed  environment.  Thus  a  positive,  consistent, 
elevation  error  is  induced  by  an  OPERATIONAL  depth  that  is 
deeper  than  ACTUAL. 

Transitioning  to  a  gradient  environment,  longbase 
still  remains  biased  toward  the  'correct'  poslocs.  A  depth 
error  to  the  interior  sensor  now  displays  the  following 
effect.  As  the  sensor  is  moved  deeper,  the  sound  velocity  of 
water  will  generally  increase.  This  causes  the  elevation 
angles  from  each  hydrophone  to  decrease  when  adjusted  to  the 
SBL  posloc.  This  change  in  elevation  angles,  with  respect  to 
depth,  will  also  be  seen  in  the  LBL  poslocs  for  the  same 
reason.  Consistency  will  still  be  present  even  with  this 
relationship  between  the  elevation  angles  and  depth. 
c.  Tilt  Angles 

The  tilt  errors,  xtilt  and  ytilt,  can  be 
visualized  as  the  orientation  of  the  plane  containing  the  X, 
Y,  and  C  hydrophones.  This  plane  will  be  defined  by  xtilt  and 
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ytilt  angles  from  an  origin  centered  at  the  C-hydrophone.  In 
the  presence  of  no  other  errors,  the  SBL  poslocs  will  be  at 
"truth"  for  the  ACTUAL  values  of  the  tilts.  It  is  in  this 
manner  that  the  correction  will  be  made.  By  constructing  two 
planes,  one  locating  the  SBL  poslocs  (erroneous)  and  the  other 
locating  the  LBL  poslocs  ("truth"),  the  difference  in  plane 
tilts  can  be  found.  This  difference  is  the  correction  to  the 
OPERATIONAL  xtilt  and  ytilt.  For  convenience,  the  regions 
closest  to  0°  and  90°  (in  the  range  coordinate  system)  are 
chosen,  although  any  two  non  collinear  combination  regions 
will  work. 

d.      X,    Y,    and  Z  Coordinate  Errors 

These  three  positional  errors  will  be  determined 
in  an  identical  manner.  Any  of  these  coordinate  errors  will 
manifest  itself  in  each  region  consistently,  although  not 
necessarily  proportionally  (see  section  2b:  Depth  by  Elevation 
Angle,  for  a  summary  of  the  unique  depth  effects) .  Errors 
from  the  comparison  of  LBL  to  SBL  posloc  positions,  averaged 
over  all  regions  will  be  used  as  a  first  guess  correction  to 
these  coordinate  errors.  Since  the  effect  of  small  angular 
errors  produces  large  positional  posloc  errors,  a  fraction  of 
this  average  error  is  used  in  order  to  guard  against 
overshoot. 
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3.   Integration  of  Error  Corrections 

The  above  individual  error  corrections  schemes  are 
listed  in  the  order  of  importance  to  the  error  fixing  (ERRFIX) 
algorithm.  The  approach  chosen  will  correct  for  angular 
errors  first,  followed  by  positional  errors.  This  choice  is 
made  due  to  the  large  displacement  effect  caused  by  the 
angular  errors  at  the  distances  of  interest. 

The  location  corrections  are  preformed  in  an  iterative 
fashion,  correcting  for  one  component  error  at  a  time.  The 
new  location  of  the  array  is  evaluated  after  each  correction, 
before  proceeding  on  to  the  next  correction.  This  allows  for 
a  controlled  approach  to  the  ACTUAL  array  location. 

Figure  8  outlines  the  ERRFIX  algorithm  and  figure  9 
the  detailed  flow  diagrams  for  the  specified  components.  The 
tilt  correction  component  of  the  first  six  error  correction 
schemes,  has  a  restriction  placed  on  it.  This  restriction 
denies  entry  if  no  other  previous  corrections  have  been  made. 
This  minimizes  the  possibility  of  unnecessary  cycling  and 
invalid  corrections  to  sensor  location.  The  adjusted  (SHIFT) 
tilt  angles  were  found  to  move  away  from  the  ACTUAL  tilt 
angles,  in  repeated  back-to-back  executions  of  the  tilt 
correction  component. 

The  tuning  constant  to  the  positional  corrections  is 
introduced  prior  to  the  individual  rectangular  coordinate 
corrections.  Since  the  angular  errors  have  not  been  totally 
adjusted   as   yet,   the   posloc   positional   errors   contain 
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influences  both  from  the  angular  and  positional  sensor 
locational  errors.  The  adjustment  of  the  positional  errors 
using  but  a  fraction  of  the  average  error  causes  the  optimal, 
or  ACTUAL,  location  to  be  approached  more  slowly.  This  is 
desirable  in  early  iterations.  As  the  number  of  passes 
through  ERRFIX  increases,  the  tuning  constant  is  increased  to 
speed  convergence  of  the  algorithm.  As  the  ACTUAL  location  is 
approached,  and  the  posloc  errors  reduced  in  magnitude,  a 
fairly  constant  correction  rate  is  then  maintained.  To  limit 
this  weighting  scheme,  so  as  not  to  overshoot  the  ACTUAL 
location,  a  ceiling  of  3  for  the  tuning  constant  is  imposed 
after  15  passes.  The  selection  of  these  number  was  based  on 
a  minimal  sensitivity  analysis  so  efficiency  is  not  expected. 

Unrestricted  position  correction  (x,  y,  and  z)  is 
allowed  after  all  the  consistent  errors  are  removed.  These 
correction  schemes  still  use  averaged  posloc  errors  and  the 
tuning  constant  in  the  computation  of  the  SHIFT  vector. 

Exit  criteria  for  ERRFIX  is  based  on  the  number  of 
passes  made  and  the  number  of  nonprof itable  attempts  to 
correct  the  sensor's  location.  The  algorithm  is  exited  after 
either  60  passes  through  ERRFIX,  or  5  non  improving  attempts 
to  correct  location  are  made.  Additional  reasons  (other  than 
to  prevent  infinite  cycling) ,  for  these  exit  criteria  are 
presented  in  chapter  IV. 
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F.   LOCATION  OPTIMIZATION  (ANNEAL) 

Since  ERRFIX  is  a  heuristic,  an  optimal  solution  is  not 
guaranteed.  A  simulated  annealing  (ANNEAL)  algorithm  is  then 
employed  to  further  minimize  the  objective  function.  The 
basis  for  this  algorithm  is  outlined  in  reference  8.  The 
random  number  generator  that  is  required  came  from  the  IMSL 
Library  of  Mathematical  and  Statistical  functions  [Ref.  9]. 
This  library  is  developed  for  IBM  PC  computers  and  compiled  in 
machine  language  and  not  reproducible  here.  Figure  10 
displays  ANNEAL' s  logic  structure. 

As  ANNEAL  is  executed  with  the  current  solution  (SHIFT) 
near  the  ACTUAL,  a  small  step  size  to  be  applied  to  SHIFT  is 
used.  This  small  step  size,  while  increasing  run  time,  also 
helps  to  prevent  overshoot  of  the  optimal  location.  The 
numbers  chosen  to  size  the  steps  are  based  upon  limited 
sensitivity  analysis  conducted  on  the  objective  function  in 
the  vicinity  of  the  minimum.  The  validation  check  for  the 
proposed  step  is  to  insure  that  the  new  angular  values  are 
within  bounds  (xtilt,  ytilt;  -7r/2  to  tt/2,  and  zrot;  -w  to  n)  . 

The  'cooling  schedule'  for  the  algorithm,  which  determines 
the  probability  of  accepting  a  nonimproving  step,  is  outlined 
in  reference  8.  A  limited  sensitivity  analysis  was  performed 
to  determine  the  parameters  used  in  the  calculation  of  the 
probabilities,  and  so  efficiency  may  not  be  achieved. 
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Figure  10.   ANNEAL  Logic  Flow  Chart. 
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Termination  for  the  ANNEAL  algorithm  is  two  fold.  Either 
30  bad  (nonimproving)  steps  accepted,  or  the  objective 
function  within  epsilon  (10"4)  of  zero,  will  cause  exiting. 
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IV.   RANGE  INTEGRATION  (CONTROL) 

Having  the  ability  to  correct  for  errors  in  an  'isolated' 
interior  array  (one  with  error  free  satellites) ,  we  turn  to 
the  problem  of  correcting  several  arrays.  In  order  to 
accomplish  this  goal,  the  first  assumption  made,  the  interior 
array's  satellites  are  error  free,  needs  to  be  removed.  To  do 
this,  an  interior  array  will  be  chosen  for  correction,  in 
which  all  of  its  satellite  arrays  are  closer  to  their  ACTUAL 
location  than  this  interior  one.  The  objective  function 
presented  on  chapter  III  will  be  utilized  to  determine  the 
array  of  interest.  By  choosing  the  array  with  the  maximum 
objective  function  value  (either  range  global,  or  with  respect 
to  its  satellites) ,  all  of  the  satellite  arrays  are  expected 
to  reguire  smaller  locational  adjustments. 

A.   CONTROL 

The  FORTRAN  program,  CONTROL,  is  set  up  to  accomplish  this 
range  wide  integration.  Two  problems  arise  when  multiple 
arrays  possess  locational  errors.  First,  in  trying  to  achieve 
locational  optimality  for  the  array  of  interest,  locational 
errors  from  the  satellite  arrays  will  prevent  the  objective 
function  from  reaching  a  zero  value.  Second,  the  sensing 
arrays  that  are  selected  for  correction  based  on  the  objective 
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function  value,  may  not  be  interior  sensors  (fewer  than  six 
triple  overlap  regions,  e.g.  array  24  of  Figure  3) . 

In  the  first  problem,  it  was  found  that  an  iterative 
procedure  was  necessary  to  correct  for  multiple  array  location 
errors.  Thus  in  ERRFIX,  the  restrictions  on  the  number  of 
passes  and  the  number  of  'bad1  steps,  was  introduced  (in 
addition  to  preventing  infinite  cycling) .  This  allows  for 
location  improvement  without  over-improving  towards  possible 
erroneous  LBL  poslocs.  After  the  array  of  interest  exits  from 
ERRFIX,  the  entire  range  is  re-examined  to  find  the  new  worst 
array,  and  the  process  repeated.  Since  correction  is  in  a 
step  wise  fashion,  entrance  into  ANNEAL  is  delayed  until  all 
arrays  are  'close'  to  their  ACTUAL  locations.  The  logic  flow 
chart  for  CONTROL  is  displayed  Figure  11. 

The  other  downside  to  'all'  the  range  arrays  possessing 
locational  errors,  is  that  there  will  be  no  anchoring  point 
for  range  location.  The  array  locations  will  be  optimized 
with  respect  to  each  other,  but  not  with  respect  to  any  fixed 
outside  point.  The  target  tracks  will  then  coincide  in  the 
overlap  regions,  but  may  not  be  the  true  track;  only  a 
relative  track. 

It  was  noted  that  arrays  with  induced  locational  errors 
produced  objective  function  values  significantly  larger  than 
the  error  free  arrays.  An  attempt  was  made  to  take  advantage 
of  this  trend.  In  singling  out  those  arrays  with  the  larger 
than   average   objective   function   values,   the   correction 
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Figure  11.   CONTROL  Logic  Flow  Chart. 
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methodology  could  be  selectively  controlled.   This  decision 
rule  has  the  advantage  of  reducing  computer  run  time  by 
eliminating  the  'error  free'  arrays  from  the  iteration 
scheme.   The  values  of  the  control  parameters  were  chosen 
arbitrarily. 

The  second  problem  addressed,  involvement  of  arrays  with 
fewer  than  six  overlap  regions,  could  not  be  studied  fully  due 
to  time  constraints.  The  problems  that  occur  here  can  be  seen 
by  a  study  of  array  number  24.  This  array  has  its  overlap 
regions  all  located  on  one  side.  This  will  cause  the  ERRFIX 
algorithm  to  induce  invalid  depth  corrections  caused  by  tilt 
errors.  Any  tilt  errors  that  happen  to  displace  all  the  SBL 
poslocs  upward  (negative  elevation  angle  errors) ,  will  be  seen 
as  a  depth  error  in  the  Depth  by  Elevation  Angle  component  of 
ERRFIX.  This  effect  will  cause  multiple  optima  to  exist  for 
these  sensors  without  a  full  complement  of  regions. 
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V.   RESULTS 

A.   ERROR  FREE  SATELLITES/  ISOSPEED  DVP 

In  this  ideal  situation,  sensor  array  15  was  chosen  as  the 
test  case.  A  random  location  ERROR  was  then  applied  to  the 
array  location.  The  initial  location  chosen  (ACTUAL) ,  is  the 
location  currently  defined  by  the  Nanoose  range.  Application 
of  the  ERROR  vector  to  this  ACTUAL  location  generated  our 
OPERATIONAL  location.   This  data  is  presented  below. 

Table  I.   SENSOR  ARRAY  15  LOCATIONAL  DATA. 


COMPONENT 

ACTUAL 
LOCATION 

INDUCED 
ERROR 

RESULTANT 

OPERATIONAL 

LOCATION 

X  (ft) 

53249.43 

11.00 

53260.43 

Y  (ft) 

-6354.60 

28.00 

-6326.60 

Z  (ft) 

1316.66 

-2.00 

1314.66 

xtilt 
(radians) 

0.003345 

0.0250 

0.028345 

ytilt 
(radians) 

0.004509 

0.0100 

0.014509 

zrot 
(radians) 

0.581544 

-0.0100 

0.571544 
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Shown  below  (Figure  12) ,  is  a  two  dimensional  depiction  of 
sensor  array  15  in  both  the  ACTUAL  and  OPERATIONAL  locations. 
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Figure  12.  ACTUAL  and 
OPERATIONAL  Location  of  Sensor 
Array  15. 


In  evaluating  this  array,  the  triple  overlap  regions 
associated  with  it  will  be  defined  in  according  to  the 
following  numbering  scheme  (refer  to  Figure  3): 


SERVING  ARRAYS 

15. 14.24 
15,  5,14 
15,  5,  6 
15,  6,16 

15. 16.25 
15,24,25 


REGION 
13 
14 
15 
21 
22 
23 
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With  the  above  numbering  system,  sensor  array  15 
(OPERATIONAL) ,  and  its  six  satellites  produce  the  following 
posloc  data  by  region: 

REGION  13 


ARRAY  15   ARRAY  14   ARRAY  24   LONGBASE 


X  posloc 
Y  posloc 
Z  posloc 


49502.98 

-8599.35 

485.07 


PHS     -2.60112 
PHL     -2.60333 


49493.30 

-8593.79 

400.00 

-0.50009 
-0.49714 


49493.30 

-8593.79 

400.00 

1.58474 
1.58175 


49506.25 

-8586.09 

436.63 


TRUTH 

49493.30 

-8593.79 

400.00 


THS 
THL 


0.19055 
0.20163 


0.21122 
0.20287 


0.20692 
0.19853 


HS 

HL 


4376.31 

4366.69 


4383.21 
4390.90 


4362.25 
4369.78 


REGION    14 


ARRAY    15      ARRAY    5 


ARRAY    14       LONGBASE 


TRUTH 


X  posloc  49371.89  49404.92  49404.92  49402.52  49402.92 
Y  posloc  -4363.58  -4356.84  -4356.84  -4356.84  -4356.84 
Z  posloc     510.17     400.00     400.00     393.66     400.00 


PHS 

2.66930 

-1.59591 

0.51668 

PHL 

2.66441 

-1.59648 

0.51724 

THS 

0.18565 

0.21220 

0.21411 

THL 

0.21244 

0.21367 

0.21557 

HS 

4361.03 

4319.56 

4322.25 

HL 

4337.52 

4318.19 

4320.87 

39 


REGION  15 


ARRAY  15  ARRAY  5  ARRAY   6   LONGBASE    TRUTH 

X  posloc  53178.27  53235.75  53235.75   53235.67   53235.75 

Y  posloc  -2053.41  -2085.69  -2085.69   -2066.51   -2085.69 

Z  posloc  421.31  400.00     400.00     358.59     400.00 

PHS  1.58878  -0.50279  -2.63487 

PHL  1.57543  -0.49884  -2.63884 

THS  0.20833  0.21566  0.21393 

THL  0.22296  0.22542  0.22368 

HS  4294.82  4248.10  4249.12 

HL  4281.08  4238.82  4239.91 


REGION    21 


ARRAY    15  ARRAY    6  ARRAY    16  LONGBASE  TRUTH 

X    posloc      57018.62  57054.98  57054.98  57067.90  57054.98 

Y    posloc      -4259.21  -4330.68  -4330.68  -4322.70  -4330.68 

Z    posloc            308.48  400.00  400.00  364.99  400.00 


PHS 

0.50664 

-1.54664 

2.65435 

PHL 

0.48823 

-1.54360 

2.65132 

THS 

0.23287 

0.21107 

0.21130 

THL 

0.21976 

0.21920 

0.21939 

HS 

4303.74 

4308.39 

4329.57 

HL 

4316.75 

4300.74 

4321.91 
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REGION  2  2 


X  posloc 
Y  posloc 
Z  posloc 


ARRAY  15   ARRAY  16   ARRAY  2  5   LONGBASE 


57060.74 

-8516.21 

285.63 


57054.15 

-8587.96 

400.00 


PHS     -0.51801   -2.61390 
PHL     -0.53291   -2.61448 


57054.15 

-8587.96 

400.00 

1.55241 
1.55302 


57051.49 

-8586.52 

407.54 


TRUTH 

57054.15 

-8587.96 

400.00 


THS 
THL 

HS 

HL 


0.23391 
0.20617 

4379.83 
4407.10 


0.20669 
0.20498 

4429.02 
4430.60 


0.18370 
0.18199 

4416.12 
4417.52 


REGION    2  3 


ARRAY    15       ARRAY    24      ARRAY    2  5       LONGBASE 


TRUTH 


X  posloc  53322.58  53293.11  53293.11  53293.83  53293.11 
Y  posloc  -10673.91  -10707.34  -10707.34  -10689.88  -10707.34 
Z  posloc     373.46     400.00     400.00     447.16     400.00 


PHS 

-1.55529 

0.54138 

2.58376 

PHL 

-1.56197 

0.54471 

2.58026 

THS 

0.21740 

0.20689 

0.18696 

THL 

0.20040 

0.19609 

0.17609 

HS 

4326.89 

4362.89 

4337.38 

HL 

4342.51 

4372.52 

4346.04 
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Summarizing  the  above  data  into  the  error  table  gives  the 
following: 


TABLE   II.     ERROR  TABLE  FOR  SENSOR  ARRAY   15   (ERROR  FREE 
SATELLITES/ ISOSPEED  DVP) 


REGION 

Attribute 

13 

14 

15 

21 

22 

23 

THER 

0.01108 

0.02679 

0.01463 

-0.01311 

-0.02775 

-0.01700 

PHER 

-0.00222 

-0.00489 

-0.01335 

-0.01840 

-0.01940 

-0.00668 

HER 

-9.622 

-23.501 

-13.739 

13.010 

27.266 

15.624 

XER 

3.278 

30.627 

57.394 

49.280 

-9.248 

-28.753 

YER 

13.258 

8.178 

-13.091 

-63.494 

-70.306 

-15.975 

ZER 

-48.436 

-116.508 

-62.719 

56.502 

121.910 

73.699 

This  test  case  shows  the  depth  exaggeration  produced  by 
LONGBASE.  The  poslocs  generated  do  not  approximate  those 
normally  encountered  on  the  range.  This  is  not  expected  since 
only  one  array  is  mispositioned  while  its  satellites  are  error 
free . 

Submitting  this  data  to  ERRFIX  the  following  solution  is 
returned  after  13  passes.  (The  algorithm  was  terminated  on 
the  5  bad  steps  criteria,  so  only  8  passes  were  needed  to 
produce  the  solution.) 
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TABLE  III.    SENSOR  ARRAY  15  ERROR  CORRECTION  DATA  (ERRFIX) 
ERROR  FREE  SATELLITES  -  ISOSPEED  DVP. 


COMPONENT 

INDUCED 
ERROR 

CORRECTED 
SHIFT 

X  (ft) 

11.000 

-11.000 

Y  (ft) 

28.000 

-28.000 

Z  (ft) 

-2.000 

2.000 

xtilt 
(radians) 

0.02500 

-0.02500 

ytilt 
(radians) 

0.01000 

-0.01000 

zrot 
(radians) 

-0.01000 

0.01000 

The  solution  presented  above  for  array  15  is  accurate  to 
the  thousandth  of  a  foot  and  less  than  a  hundred  thousandth  of 
a  radian.  The  above  solution  was  achieved  without  utilizing 
the  ANNEAL  algorithm. 

Several  other  test  cases  for  array  15  were  run  to  verify 
the  algorithm  following  the  same  format  as  above.  The  results 
of  the  induced  ERROR  and  the  corrected  SHIFT  are  presented  on 
the  next  page  (Table  IV) . 
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B.   INTERIOR   ARRAY   CORRECTION    (SATELLITES   WITH   ERRORS/ 
ISOSPEED  DVP) 

The  ERRFIX  and  ANNEAL  algorithms  are  now  checked  for 
performance  on  an  interior  array  whose  satellites  contain 
locational  errors.  Array  15  is  again  chosen  as  the  array  of 
interest.  The  ERRORS  induced  on  the  arrays  are  such  that 
array  15  will  have  the  largest  objective  function  with  respect 
to  its  satellites.  Table  V  on  the  next  page,  displays  the 
ERRORS  induced  for  all  the  arrays.  These  ERRORS  were  chosen 
so  as  to  obtain  initial  posloc  data  similar  to  that  normally 
seen  on  the  range.  Appendix  H  displays  the  regional  posloc 
data . 

Submission  of  this  data  to  ERRFIX  produced  the  following 
corrections  to  array  15  (Table  VI)  after  one  pass.  ERRFIX  was 
exited  after  11  passes,  the  last  five  non  improving.  With  the 
exception  of  the  ytilt  component,  the  locational  errors  are 
reduced  by  65  to  97%.  The  ytilt  component  was  over  corrected 
and  increased  its  error  magnitude  by  142%.  Table  VI  also 
shows  the  cumulative  corrections  produced  by  ANNEAL,  using  the 
ERRFIX  corrections  as  input.  The  y  and  ytilt  component  errors 
are  improved  in  ANNEAL  while  the  other  component  errors  are 
degraded.  This  supports  the  previous  assessment  of 
iteratively  correcting  the  arrays  iteratively  through  ERRFIX 
before  attempting  ANNEAL. 
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TABLE  VI.   ACCUMULATED  CORRECTIONS  FOR  ARRAY  15.  ERROR 
INDUCED  SATELLITES  -  ISOSPEED  DVP. 


COMPONENT 

INDUCED 
ERROR 

ERRFIX 
CORRECTION 

ANNEAL 
CORRECTION 

X  (ft) 

11.000 

-11.756 

-15.789 

Y  (ft) 

28.000 

-35.444 

-29.434 

Z  (ft) 

-2.000 

2.706 

4.577 

xtilt 

(radians) 

0.00400 

-0.00444 

-0.00727 

ytitlt 
(radians) 

0.00500 

-0.01209 

-0.00714 

zrot 
(radians) 

-0.01000 

0.00973 

0.00942 

C.   CORRECTION  OF  MULTIPLE  INTERIOR  ARRAYS  (ISOSPEED  DVP) 

After  verifying  the  ERRFIX  and  ANNEAL  algorithms  work 
properly,  correction  for  multiple  interior  arrays  are  now 
preformed.  ERRORS  are  induced  in  the  six  interior  arrays  (see 
Figure  3)  of  the  range,  4,  5,  6,  14,  15,  and  16.  Table  VII 
displays  the  induced  ERRORS.  The  exterior  arrays  are  all 
properly  located  in  this  example. 

It  was  necessary  to  place  a  'no  repeat'  restriction  on  the 
arrays  for  entry  into  ERRFIX.  This  restriction  prevented  the 
CONTROL  algorithm  from  cycling  on  one  single  array.  Iterative 
passes  through  ERRFIX  was  terminated  when  all  the  objective 
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functions  were  less  than  one.  The  choice  of  one  was 
arbitrarily  chosen  to  speed  convergence  (entry  to  ANNEAL) . 
Due  to  the  consistency  of  errors  approach  in  ERRFIX,  as  the 
ACTUAL  location  is  approached,  the  magnitude  of  the  correction 
is  decreased.  Presented  below  (Tables  VIII  -  XIII)  are  the 
corrections  (SHIFTS)  produced  from  ERRFIX  at  the  termination 
criteria  mentioned  above. 


TABLE  VIII.     ACCUMULATED  CORRECTIONS   FOR  ARRAY 
ERROR  INDUCED  INTERIOR  ARRAYS  -  ISOSPEED  DVP . 


COMPONENT 

INDUCED 
ERROR 

ERRFIX 
CORRECTION 

ANNEAL 
CORRECTION 

X  (ft) 

-0.500 

0.420 

0.506 

Y  (ft) 

-1.000 

0.664 

0.980 

Z  (ft) 

0.700 

-0.589 

0.668 

xtilt 
(radians) 

-0.00600 

0.00594 

0.00599 

ytitlt 
(radians) 

0.00300 

-0.00288 

-0.00298 

zrot 

(radians) 

-0.00200 

0.00206 

0.00200 
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TABLE  IX.   ACCUMULATED  CORRECTIONS  FOR  ARRAY   5. 
INDUCED  INTERIOR  ARRAYS  -  ISOSPEED  DVP. 


ERROR 


COMPONENT 

INDUCED 
ERROR 

ERRFIX 
CORRECTION 

ANNEAL 
CORRECTION 

X  (ft) 

7.900 

-7.728 

-7.978 

Y  (ft) 

-6.200 

5.563 

6.159 

Z  (ft) 

-1.800 

2.846 

1.939 

xtilt 
(radians) 

0.00700 

-0.00677 

-0.00702 

ytitlt 
(radians) 

-0.00300 

0.00294 

0.00298 

zrot 
(radians) 

0.00100 

-0.00099 

-0.00100 

TABLE  X.   ACCUMULATED  CORRECTIONS  FOR  ARRAY 
INDUCED  INTERIOR  ARRAYS  -  ISOSPEED  DVP. 


ERROR 


COMPONENT 

INDUCED 
ERROR 

ERRFIX 
CORRECTION 

ANNEAL 
CORRECTION 

X  (ft) 

-5. 000 

5.373 

4.975 

Y  (ft) 

7.000 

-7.936 

-7.009 

Z  (ft) 

4.000 

-2.754 

3.808 

xtilt 
(radians) 

0.00500 

-0.00499 

-0.00498 

ytitlt 
(radians) 

0.00200 

-0.00243 

-0.00200 

zrot 
(radians) 

-0.00300 

0.00297 

0.00300 
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TABLE  XI.   ACCUMULATED  CORRECTIONS  FOR  ARRAY  14 
INDUCED  INTERIOR  ARRAYS  -  ISOSPEED  DVP. 


ERROR 


COMPONENT 

INDUCED 
ERROR 

ERRFIX 
CORRECTION 

ANNEAL 
CORRECTION 

X  (ft) 

4.000 

-3.941 

-4.027 

Y  (ft) 

-8.000 

8.009 

7.994 

Z  (ft) 

5.000 

-4.917 

4.994 

Xtilt 
(radians) 

-0.00900 

0.00915 

0.00901 

ytitlt 
(radians) 

-0.00400 

0.00392 

0.00401 

zrot 
(radians) 

0.00300 

-0.00298 

-0.00300 

TABLE   XII.     ACCUMULATED   CORRECTIONS   FOR   ARRAY   15 
ERROR  INDUCED  INTERIOR  ARRAYS  -  ISOSPEED  DVP. 


COMPONENT 

INDUCED 
ERROR 

ERRFIX 
CORRECTION 

ANNEAL 
CORRECTION 

X  (ft) 

11.000 

-10.650 

-11.029 

Y  (ft) 

28.000 

-28.858 

-28.019 

Z  (ft) 

-2.000 

1.149 

2.064 

xtilt 
(radians) 

0.02500 

-0.02451 

-0.02499 

ytitlt 
(radians) 

0.01000 

-0.01020 

-0.01002 

zrot 
(radians) 

-0.01000 

0.01004 

0.01000 
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TABLE   XIII.     ACCUMULATED   CORRECTIONS   FOR  ARRAY   16 
ERROR  INDUCED  INTERIOR  ARRAYS  -  ISOSPEED  DVP . 


COMPONENT 

INDUCED 
ERROR 

ERRFIX 
CORRECTION 

ANNEAL 
CORRECTION 

X  (ft) 

5.000 

-5.203 

-5.004 

Y  (ft) 

-2.000 

1.031 

2.001 

Z  (ft) 

4.000 

-5.132 

-3.974 

xtilt 
(radians) 

0.00400 

-0.00336 

-0.00400 

ytitlt 
(radians) 

0.00200 

-0.00192 

-0.00200 

zrot 
(radians) 

0.00100 

-0.00102 

-0.00100 

ERRFIX  corrected  well  for  all  locational  components  except 
depth.  The  corrections  provided  by  ERRFIX  left  errors  of  at 
most  58%  remaining  (depth  correction  for  array  5) .  The  only 
other  locational  component  approaching  this  magnitude  is  the 
y  component  for  array  16  (48%  error  remaining) .  Internal 
passes  through  ERRFIX  provided  for  improvements  in  all  cases 
before  termination  (on  5  non  improving  passes) . 

Once  all  the  interior  array  objective  functions  fell  below 
one,  control  was  passed  to  ANNEAL.  The  restriction  of  no 
'back  to  back1  corrections  for  an  array  was  also  in  place 
here.   Convergence  within  ANNEAL  was  generally  quick,  with 
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termination  occurring  on  30  consecutive  nonimproving  steps 
accepted  in  the  search.  In  order  to  maximize  the  potential 
for  optimization,  an  internal  control  structure  was  added  to 
ANNEAL  to  increase  the  step  size  and  then  decrease  the  bad 
step  acceptance  probability.  As  soon  as  a  lower  objective 
function  value  is  found  (over  the  previous  minimum) ,  the 
parameters  are  returned  to  their  initial  values.  ANNEAL 
termination  occurs  after  1500  passes  with  the  larger  step  size 
and  lower  probability,  if  a  lower  objective  function  value  has 
not  been  found.  This  exit  condition  was  only  invoked  three 
times  in  the  above  test  case.  The  results  of  ANNEAL 
performance  (cumulative  corrections)  are  displayed  along  with 
the  ERRFIX  corrections  in  Tables  VIII  to  XIII. 

CONTROL  was  terminated  when  any  array's  objective  function 
value  increased  after  a  return  from  ANNEAL.  This  occurred 
with  array  15,  after  a  total  of  33  array  entrances  into  ANNEAL 
(this  was  array  15' s  seventh  entry  to  ANNEAL). 
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VI.   CONCLUSIONS  AND  RECOMMENDATIONS 


A.   RESULTS 

The  goal  of  this  thesis  was  to  investigate  interior  sensor 
array  locational  errors,  and  develop  a  set  of  decision  rules 
to  correct  any  errors  that  may  exist.  The  primary  tools  used 
here  include,  long  baseline  methodology  and  a  consistency  of 
errors  approach. 

It  was  found  that  although  LONGBASE  was  written  under  the 
caveat  of  no  positional  array  errors  existing,  it  could  still 
be  used  to  aid  in  correction  of  an  array's  location.  In  fact 
it  worked  better  than  using  an  averaged  consensus  posloc  (of 
the  three  SBL  poslocs)  to  compare  the  SBL  poslocs  against. 

The  current  research  did  not  assume  that  the  exterior 

arrays  (those  with  fewer  than  six  triple  overlap  regions)  were 

locationally  in  error.   Investigation  of  their  inclusion  into 

the  error  correction  methodology  was  not  conducted,  so  their 

/ci- 
ef  feet  on  the  algorithms  is  undetermined.   The  test  cases  r^n 

in  this  study  also  used  an  isospeed  DVP.  Appendix  A  addresses 

the  effects  of  a  DVP  containing  a  gradient.   The  resultant 

gradient  induced  errors  resulting  from  the  use  of  Professor 

Read's  recommended  ray  tracing  initialization  method,  are 
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shown  to  be  small  in  magnitude.   Time  constraints  prevented  a 
study  of  their  effect  on  the  error  correction  scheme. 

The  final  algorithms,  ERRFIX  and  ANNEAL,  have  demonstrated 
excellent  robustness  in  the  correction  of  locational  errors. 
An  annealing  algorithm,  by  itself,  may  be  able  to  successfully 
minimize  array  locational  errors.  Since  the  array's  location 
is  six  dimensional,  it  was  deemed  unreasonable  to  rely  solely 
on  this  technigue  in  order  to  keep  computer  run  time  down. 
The  error  correction  algorithms  were  written  so  as  to  be  able 
to  accept  raw  tracking  data  from  the  range.  The  data  used  in 
the  study  here  was  internally  generated  to  eliminate  any 
systematic  error  sources  commonly  found  in  an  underwater 
tracking  situation.  Times  provided  by  the  range  are  generally 
suspect  in  themselves,  thus  preventing  'error  free'  posloc 
determination . 

B.   RECOMMENDATIONS  FOR  FURTHER  RESEARCH 

In  expanding  this  technique  to  the  entire  tracking  range, 
three  problems  need  to  be  analyzed. 

First,  there  is  the  treatment  of  exterior  arrays.  The  use 
of  these  arrays  in  the  current  methodology  may  have 
insufficient  consistency  of  errors  to  provide  locating 
information.  The  use  of  double  overlap  regions  [Refs.  4,5, 
and  6],  may  be  necessary  to  supply  enough  data  to  accurately 
correct  these  exterior  arrays. 
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Second,  the  optimization  of  the  internal  control 
parameters  in  the  ERRFIX,  ANNEAL  and  CONTROL  algorithms  is 
necessary  before  attempting  entire  range  correction.  This 
will  also  reduce  computer  run  time  allowing  for  more  frequent 
calibration  updates.  The  run  times  in  solving  for  a  single 
array  with  error  free  satellites  was  on  the  order  of  5 
minutes.  The  case  of  solving  for  all  the  interior  arrays 
required  about  one  and  half  hours. 

The  third  area  of  work,  is  the  effect  of  gradient  water 
environments.  Although  the  errors  seen  resulting  from  the 
gradients  are  'small1,  the  effect  on  an  iterative  correction 
scheme  may  be  multiplictative  thus  inhibiting  the  correction 
of  the  true  locational  errors. 
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APPENDIX  A:   GRADIENT  DVPs  AND  RAY  TRACING  INITIALIZATION 

An  isospeed  DVP  was  used  during  the  formulation  of  this 
correction  method.  This  had  the  advantage  of  eliminating 
extraneous  errors  from  the  analysis. 

About  third  of  posloc  errors  were  estimated  to  be  due  to 
the  ray  tracing  initialization  in  a  gradient  DVP  environment. 
The  study  performed  in  reference  1,  showed  that  the  current 
ray  tracing  initialization  method  used  by  NUWES  produced 
errors  on  the  order  of  feet  in  depth  and  horizontal  range,  and 
third  decimal  place  (radians)  in  elevation  and  azimuth  angles. 
The  method  recommended  by  Professor  Read  reduced  these  errors 
by  a  factor  of  10  for  depth,  horizontal  range,  and  elevation 
angle,  and  a  factor  of  100  for  azimuth  angle. 

Figure  4  of  reference  1,  showed  a  sinusoidal  nature  to 
each  of  the  above  error  components.  The  skewed  nature  of  the 
curves  produced  made  direct  analysis  difficult.  Standardizing 
the  array  axis  (setting  xtilt  =  ytilt  =  zrot  =  0)  produced  the 
following  curves  (Figure  13) .  This  figure  mimics  Figure  4  of 
reference  1,  array  1  with  the  DVP  of  3/22/89  used  for  sound 
sources  at  3000,  4000  and  5000  feet. 

With  a  standardized  local  coordinate  system  the  sinusoidal 
nature  of  the  errors  becomes  visible.  Analysis  of  the  angular 
errors  (azimuth  and  elevation  angles)  shows  the  errors  to  be 
90°  out  of  phase.   The  zero  error  points  for  azimuthal  error 
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Figure  13.   Gradient  Induced  Sinusoidal  Errors 
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occurs  at  45°  and  235°  rotation  (CCW  from  east,  the  x  axis)  . 
This  corresponds  to  the  point  where  the  sound  source  is 
equidistant  from  both  the  x  and  y  hydrophones.  The  maximum 
azimuthal  error  occurs  at  135°  and  325°,  90°  out  from  the  zero 
errors.  These  points  are  where  the  sound  source  has  maximum 
distance  to  one  of  the  hydrophones  (x  or  y)  ,  and  minimum 
distance  to  the  other.  The  elevation  angles  display  the 
opposite  phenomenon,  maximum  errors  where  the  sound  source  is 
equidistant  form  the  x  and  y  hydrophones,  and  zero  error  at 
the  maximum/minimum  distance  to  one  or  the  other. 

This  effect  on  the  errors  is  traced  back  to  the  geometric 
construction  of  the  posloc  point  to  initialize  Professor 
Read's  ray  tracing  method.  A  constant  speed  of  sound  in  water 
is  used  to  construct  this  posloc  point.  This  speed  of  sound 
used  (the  speed  at  the  level  of  the  x,  y,  and  c  hydrophones) 
is  larger  than  the  speed  found  along  the  ray  path.  (Speed  of 
sound  in  water  generally  decreases  as  you  get  shallower.) 
This  larger  speed  of  sound  used  causes  the  distance  traveled 
back  along  the  ray  path  to  be  longer  than  it  is  in  reality. 
Thus  the  sinusoidal  nature  of  the  errors  occur  with  respect  to 
the  array  axis,  or  the  sides  of  the  pyramid  constructed  to 
locate  the  posloc.  The  discrepancies  observed  in  figure  13 
are  the  result  of  time  differences  (time  from  constructed  ray 
paths  versus  real  transit  times)  in  the  ninth  and  tenth 
decimal  place. 
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Before  proceeding  in  an  attempt  to  correct  the  effect,  the 
posloc  errors  produced  are  examined.  Using  array  15,  with 
ERROR  free  satellites  and  an  isogradient  DVP  (+  0.08  ft/sec), 
the  following  correction  data  is  produced  (Table  XIV) . 


TABLE  XIV.     CORRECTIONS  FOR  ARRAY   15   ERROR  INDUCED 
SATELLITES  -  ISOGRADIENT  DVP. 


COMPONENT 

INDUCED 
ERROR 

ERRFIX 
CORRECTION 

ANNEAL 
CORRECTION 

X  (ft) 

11.000 

-11.001 

-11.001 

Y  (ft) 

28.000 

-28.003 

-28.003 

Z  (ft) 

-2.000 

1.994 

1.994 

xtilt 
(radians) 

0.02500 

-0.02505 

-0.02505 

ytitlt 
(radians) 

0.01000 

-0.01005 

-0.01005 

zrot 
(radians) 

-0.01000 

0.01000 

0.01000 

60 


The  following  regional  posloc  data  is  provided  to  give  the 
reader  an  idea  as  to  the  effect  this  gradient  has  on  the 
poslocs.  The  magnitude  of  the  posloc  errors  are  proportional 
to  the  gradient  of  the  DVP. 


REGIONAL  POSLOC  DATA  BEFORE  ERRFIX 


ARRAY  15  SBL 

X  49502.76 

Y  -8600.14 

Z  484.96 

THS  0.18338 

THL  0.19475 

PHS  -2.60099 

PHL  -2.60333 

HS  4376.91 

HL  4366.68 


REGION   13 
ARRAY  14  SBL 
49493.37 
-8593.79 
400.27 
0.20397 
0.19595 
-0.50009 
-0.49714 
4383.27 
4390.91 


ARRAY  24  SBL 
49493.35 
-8593.85 
399.72 
0.19983 
0.19164 
1.58473 
1.58175 
4362.19 
4369.79 


LONGBASE 
49506.26 
-8586.09 
435.37 


GOAL 
49493.30 
-8593.79 
400.00 


ARRAY  15  SBL 

X  49371.31 

Y  -4363.06 

Z  509.94 

THS  0.17852 

THL  0.20527 

PHS  2.66925 

PHL  2.66441 

HS  4361.78 

HL  4337.51 


REGION   14 
ARRAY   5  SBL 
49404.88 
-4356.78 
399.77 
0.20517 
0.20654 
-1.59592 
-1.59647 
4319.51 
4318.20 


ARRAY  14  SBL 
49404.99 
-4356.83 
400.26 
0.20696 
0.20844 
0.51667 
0.51724 
4322.31 
4320.87 


LONGBASE 
49402.53 
-4355.41 
393.90 


GOAL 
49404.92 
-4356.84 
400.00 


ARRAY  15  SBL 

X  53179.04 

Y  -2053.32 

Z  421.03 

THS  0.20135 

THL  0.21564 

PHS  1.58860 

PHL  1.57543 

HS  4294.90 

HL  4281.07 


ARRAY  15  SBL 

X  57018.23 

Y  -4260.02 

Z  308.33 

THS  0.22589 

THL  0.21243 

PHS  0.50651 

PHL  0.48823 

HS  4303.00 

HL  4316.74 


REGION   15 

ARRAY   5  SBL 

53235.71 

-2085.64 

399.72 

0.20876 

0.21817 

-0.50279 

-0.49884 

4248.04 

4238.83 

REGION   21 

ARRAY   6  SBL  - 

57054.97 

-4330.75 

400.30 

0.20394 

0.21190 

-1.54665 

-1.54360 

4308.46 

4300.75 


ARRAY   6  SBL 
53235.73 
-2085.75 
400.19 
0.20691 
0.21643 
-2.63486 
-2.63884 
4249.16 
4239.92 


ARRAY  16  SBL 
57054.96 
-4330.62 
400.20 
0.20415 
0.21205 
2.65434 
2.65132 
4329.61 
4321.92 


LONGBASE 
53235.67 
-2066.52 
359.91 


LONGBASE 
57067.89 
-4322.71 
366.14 


GOAL 
53235.75 
-2085.69 
400.00 


GOAL 
57054.98 
-4330.68 
400.00 
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ARRAY  15  SBL 

X  57060.09 

Y  -8515.56 

Z  285.62 

THS  0.22678 

THL  0.19899 

PHS  -0.51795 

PHL  -0.53290 

HS  4378.94 

HL  4407.09 


REGION   22 
ARRAY  16  SBL 
57054.14 
-8587.89 
399.90 
0.19945 
0.19777 
-2.61391 
-2.61448 
4429.00 
4430.60 


ARRAY  2  5  SBL 
57054.14 
-8588.02 
399.69 
0.17652 
0.17480 
1.55241 
1.55302 
4416.06 
4417.53 


LONGBASE  GOAL 

57051.48  57054.15 

-8586.51  -8587.96 

407.29  400.00 


ARRAY  15  SBL 

X  53323.36 

Y  -10673.68 

Z  373.44 

THS  0.21032 

THL  0.19366 

PHS  -1.55511 

PHL  -1.56197 

HS  4326.67 

HL  4342.48 


REGION   23 
ARRAY  24  SBL 

53293.16 
-10707.40 
400.05 
0.19972 
0.18930 
0.54136 
0.54472 
4362.90 
4372.52 


ARRAY  2  5  SBL 
53293.10 

-10707.39 
399.89 
0.17987 
0.16935 
2.58377 
2.58026 
4337.36 
4346.07 


LONGBASE  GOAL 

53293.81  53293.11 

•10689.86  -10707.34 

445.45  400.00 


REGIONAL  POSLOC  DATA  AFTER  ERRFIX 


ARRAY  15  SBL 

X  49493.30 

Y  -8593.79 

Z  399.99 

THS  0.20342 

THL  0.20342 

PHS  -2.60761 

PHL  -2.60761 

HS  4358.54 

HL  4358.55 


REGION   13 
ARRAY  14  SBL 
49493.37 
-8593.79 
400.27 
0.20397 
0.20403 
-0.50009 
-0.50009 
4383.27 
4383.20 


ARRAY  24  SBL 
49493.35 
-8593.85 
399.72 
0.19983 
0.19976 
1.58473 
1.58474 
4362.19 
4362.25 


LONGBASE 
49493.30 
-8593.79 
400.00 


GOAL 
49493.30 
-8593.79 
400.00 


ARRAY  15  SBL 

X  49404.92 

Y  -4356.84 

Z  400.00 

THS  0.20440 

THL  0.20440 

PHS  2.65763 

PHL  2.65763 

HS  4338.39 

HL  4338.39 


REGION   14 

ARRAY   5  SBL 

49404.88 

-4356.78 

399.77 

0.20517 

0.20512 

-1.59592 

-1.59591 

4319.51 

4319.56 


ARRAY  14  SBL 
49404.99 
-4356.83 
400.26 
0.20696 
0.20702 
0.51667 
0.51668 
4322.31 
4322.25 


LONGBASE 
49404.92 
-4356.84 
400.00 


GOAL 
49404.92 
-4356.84 
400.00 
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ARRAY  15  SBL 

X  53235.75 

Y  -2085.69 

Z  400.01 

THS  0.20680 

THL  0.20680 

PHS  1.57297 

PHL  1.57297 

HS  4289.76 

HL  4289.76 


REGION   15 

ARRAY   5  SBL 

53235.71 

-2085.64 

399.72 

0.20876 

0.20870 

-0.50279 

-0.50279 

4248.04 

4248.10 


ARRAY   6  SBL 
53235.73 
-2085.75 
400.19 
0.20691 
0.20696 
-2.63486 
-2.63487 
4249.16 
4249.12 


LONGBASE 
53235.75 
-2085.69 
400.00 


GOAL 
53235.75 
-2085.69 
400.00 


ARRAY  15  SBL 

X  57054.98 

Y  -4330.68 

Z  400.00 

THS  0.20511 

THL  0.20511 

PHS  0.49257 

PHL  0.49257 

HS  4323.92 

HL  4323.92 


REGION   21 

ARRAY   6  SBL 

57054.97 

-4330.75 

400.30 

0.20394 

0.20401 

-1.54665 

-1.54665 

4308.46 

4308.39 


ARRAY  16  SBL 
57054.96 
-4330.62 
400.20 
0.20415 
0.20420 
2.65434 
2.65435 
4329.61 
4329.57 


LONGBASE 
57054.98 
-4330.68 
400.00 


GOAL 
57054.98 
-4330.68 
400.00 


ARRAY  15  SBL 

X  57054.15 

Y  -8587.96 

Z  400.00 

THS  0.20118 

THL  0.20118 

PHS  -0.52622 

PHL  -0.52622 

HS  4405.03 

HL  4405.03 


REGION   22 
ARRAY  16  SBL 
57054.14 
-8587.89 
399.90 
0.19945 
0.19942 
-2.61391 
-2.61390 
4429.00 
4429.02 


ARRAY  2  5  SBL 
57054.14 
-8588.02 
399.69 
0.17652 
0.17646 
1.55241 
1.55241 
4416.06 
4416.12 


LONGBASE 
57054.15 
-8587.96 
400.00 


GOAL 
57054.15 
-8587.96 
400.00 


ARRAY  15  SBL 

X  53293.11 

Y  -10707.34 

Z  399.99 

THS  0.20470 

THL  0.20470 

PHS  -1.55971 

PHL  -1.55971 

HS  4332.16 

HL  4332.16 


REGION   23 
ARRAY  24  SBL 

53293.16 
-10707.40 
400.05 
0.19972 
0.19973 
0.54136 
0.54138 
4362.90 
4362.89 


ARRAY  2  5  SBL 
53293.10 

-10707.39 
399.89 
0.17987 
0.17984 
2.58377 
2.58376 
4337.36 
4337.38 


LONGBASE 
53293.11 
■10707.34 
400.00 


GOAL 
53293.11 
-10707.34 
400.00 
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After  ERRFIX,  and  array  15  has  almost  all  of  its 
locational  errors  corrected.  The  remaining  errors  are  seen  in 
every  array  and  are  the  result  of  the  gradient.  The  LBL 
poslocs  generated  in  this  environment  are  coincident  with  the 
true  (goal)  posloc.  With  error  free  arrays,  the  gradient  does 
not  prevent  LONGBASE  from  accurately  determining  the  targets 
position. 
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APPENDIX    B:       COMPUTER    PROGRAMS    SIMSTRT    AND    SETUP 

SUBROUTINE    SIMSTRT ( DVP , EXT , RTIME , RORIGIN ) 

* 

*  THIS  SUBROUTINE  GENERATES  THE  TRANSIT  TIMES  (RTIME)  FROM  A 

*  STARTING  POINT  ON  THE  RANGE  (RORIGIN)  WHICH  IS  GENERATED  BY  THE 

*  SUBROUTINE  POINST.   THIS  SUBROUTINE  IS  TO  INITIATE  THE  NANOOSE  RANGE 

*  SIMULATION  FOR  ERROR  CORRECTIONS.   THE  OUTPUTS  CREATED  BY  THIS 

*  PROGRAM  SHOULD  BE  THE  SAME  AS  INPUTS  RECEIVED  BY  THE  RANGE  (EXCEPT 

*  RORIGIN  WHICH  IS  USED  TO  MONITOR  SIMULATION  PROGRESS) 

* 

*  INPUTS: 

*  DVP    :  THE  INDEX  OF  THE  DEPTH  VELOCITY  PROFILE  TO  BE  USED 

*  EXT    :  EXTRAPOLATION  CONTROL  FOR  SUBROUTINE  VELPRO 
* 

*  OUTPUTS: 

*  RTIME  :  ARRAY  CONTAINING  TRANSIT  TIMES  FROM  A  LOCATION  TO  A  SENSOR 

*  DIMENSIONED  AS  FOLLOWS:  ( SENSOR, REGION, I )  WHERE  1=1-4  THE 

*  TIMES  FROM  THE  X,Y,Z,C  PHONES  RESPECTIVELY 

*  RORIGIN  :  ARRAY  CONTAINING  THE  TRUE  LOCATION  OF  THE  TARGET  IN  RANGE 

*  COORDINATES,  DIMENSIONED:  (REGION, I)  1=1-3  FOR  X,Y,Z 

*  J. A.  GEMBARSKI 

*  NPS    03/01/02 

* 

DIMENSION  XP(3) ,YP(3) ,ZP(3) ,CP(3) ,A(3) , RTIME ( 0 : 57 , 27 , 4 ) , 
&  AR ( 3 ) , XPHLOC (7,3), YPHLOC (7,3), ZPHLOC (7,3), CPHLOC (7,3), 

&  RORIGIN (2 7, 3) ,X(3) , ORIGIN (6, 3) , 

&  L(300) ,VEL(300) ,V0(300) , VI ( 300 ) , LM ( 300 ) , DZ ( 300 ) , 

&  J(6) , LINKS (18) ,SENSR(7) ,XS(18,3) 

* 

COMMON  /SET1/  L, VEL, V0 , VI , DZ , LM, M 

INTEGER    SENSR, J, ERR, K, NR, H, KK, N, M, AR, LINKS , NSBL, S , 
&  LP, MP, IEST,EXT,I,DVP 

* 

DOUBLE  PRECISION  ORIGIN, XS, XPHLOC, YPHLOC, ZPHLOC, CPHLOC, X, A 

DOUBLE  PRECISION  XP, YP , ZP, CP , Al , A2 , PI , P2 , V0 , VI , LM, L, VEL, DZ 

DOUBLE  PRECISION  TH1 , TH2 , RTIME , RORIGIN 
* 

LOGICAL    TEST 
CHARACTER* 15  NAME1 

* 

DO  3  1=1,300 


L(I) 

=  0.0 

VEL ( I ) 

=  0.0 

V0(I) 

=  0.0 

VI  (I) 

=  0.0 

DZ(I) 

=  0.0 

LM(I) 

=  0.0 

CONTINUE 

ERR  =  0 
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DO  30  S  =0,57 
SENSR(l)  =  S 

* 

*  FIND  THE  CORRESPONDING  OVERLAP  REGIONS  AND  ADJACENT  ARRAYS 
* 

CALL  FINDOVR(S, J, ERR) 
IF(ERR.EQ.l)  GOTO  30 

NR  =  1 

DO  10  LP  =  1,6 

IF(J(LP) .NE.O)  NR=NR+1 

10  CONTINUE 
NR  =  NR-1 

H=l 
K=l 
KK=2 

N  =  l 

12  IF( J(K) .NE.0)THEN 

LINKS(N)=1 

CALL  OVERLAP ( J (K) ,AR, ERR) 

DO  13  LP=1,3 
MP=1 

11  IF(SENSR(MP) .NE.AR(LP) ) THEN 

TEST=.TRUE. 

MP=MP+1 
ELSE 

TEST=. FALSE. 
ENDIF 
IF (TEST. AND.  MP.LT.KK)  GOTO  11 

IF(TEST)THEN 

SENSR(KK)=AR(LP) 

LINKS(N+H)=KK 

KK=KK+1 

H=H+1 
ELSEIF(SENSR(1) .NE.AR(LP) ) THEN 

LINKS(N+H)=MP 

H=H+1 
ENDIF 

13  CONTINUE 

H=l 
K=K+1 
N=N  +  3 

IF(K.LE.6)  GOTO  12 
ENDIF 
* 

*  FIND  THE  NUMBER  OF  SHORT  BASE  LINE  POSLOC  NSBL 
* 

NSBL  =  N-l 

* 

*  LOCATE  THE  TARGET  POSLOC  IN  EACH  CROSSOVER  REGION 

* 

DO  14  LP=1,NR 

CALL  POINTST(J(LP) , ORIGIN (LP, 1 ) , ORIGIN (LP, 2 ) , ORIGIN (LP, 3 ) ) 
DO  26  H  =  1,3 

RORIGIN(J(LP) ,H)  =  ORIGIN(LP,H) 
26     CONTINUE 
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14  CONTINUE 
* 

*  IDENTIFY  AN  UNIQUE  POSLOC  FOR  EACH  ARRAY  IN  EACH  CROSSOVER  REGION 

* 

H=l 

DO  20  LP=1,NSBL 

XS(LP,l)=ORIGIN(H,l) 

XS(LP,2)=ORIGIN(H,2) 

XS(LP,3)=ORIGIN(H,3) 

IF (MOD (LP, 3) .EQ.O)  H=H+1 

20  CONTINUE 
* 

C  IDENTIFY  THE  GLOBAL  COORDINATES  OF  EACH  HYDROPHONE  OF  EACH  SENSOR 

C  TO  CALCULATE  THE  TRUE  TRANSIT  TIMES 

* 

A2  =  0.0 
DO  21  LP=1, (KK-1) 

CALL  ARRAY ( SENSR (LP),X(1),X(2),X(3),A(1),A(2),A(3), ERR ) 
CALL  GLOBE(X,A,XP,YP,ZP,CP) 

DO  22  N=l,3 

XPHLOC(LP,N)=XP(N) 
YPHLOC(LP,N)=YP(N) 
ZPHLOC(LP,N)=ZP(N) 
CPHLOC(LP,N)=CP(N) 
22     CONTINUE 

IF(XP(3) .GT.A2)A2  =  XP ( 3 ) 
IF(YP(3) .GT.A2)A2  =  YP(3) 
IF(ZP(3) .GT.A2)A2  =  ZP(3) 
IF(CP(3) ,GT.A2)A2  =  CP(3) 

21  CONTINUE 
* 

C  RETRIEVE  THE  VELOCITY  PROFILE  INFORMATION 

* 

IF ( EXT. NE. 2) EXT  =  0 

CALL  VELPRO (0, NAME 1,DVP, EXT, A2) 
* 

C  CALCULATE  TRANSIT  TIMES  FROM  EACH  POSLOC  TO  EACH  HYDROPHONE 

C  THE  SECOND  INDEX  ON  TIME  INDICATES  THE  HYDROPHONE:  1,2,3,4  FOR 

C  X,Y,Z,C  RESPECTIVELY  (THIS  INFORMATION  IS  NORMALLY  SUPPLIED  BY 

C  THE  RANGE) 

* 

H  =  1 

DO  25  LP=1,NSBL 

Al  =  0.0D0 

A2  =  XPHLOC( LINKS (LP) ,3) 

PI  =  DSQRT(  (XS(LP,l)-XPHLOC(LINKS(LP) ,1) )**2  + 
+  (XS(LP,2)-XPHLOC(LINKS(LP),2) )**2  ) 

P2  =  XS(LP,3) 

IEST  =  0 

CALL  RAYFIT1(A1,A2,P1,P2,M,VEL,LM,DZ,V0,V1, 
&  RTIME( SENSR (LINKS (LP) ) , J(H) ,1) , TH2 , TH1 , IEST) 

A2  =  YPHLOC( LINKS (LP) ,3) 

PI  =  DSQRT(  (XS(LP,l)-YPHLOC(LINKS(LP) ,1) )**2  + 
+  (XS(LP,2)-YPHLOC(LINKS(LP) ,2) )**2    ) 

IEST  =  0 

CALL  RAYFIT1(A1,A2,P1,P2,M,VEL,LM,DZ,V0,V1, 
&  RTIME( SENSR (LINKS (LP) ) , J(H) ,2) , TH2 , TH1 , IEST) 
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A2  =  ZPHLOC( LINKS (LP) ,3) 

PI  =  DSQRT(  (XS(LP,l)-ZPHLOC(LINKS(LP) ,1) )**2  + 

(XS(LP,2)-ZPHLOC(LINKS(LP) , 2)  )**2    ) 
IEST  =  0 

CALL  RAYFIT1(A1,A2,P1,P2,M,VEL,LM,DZ,V0,V1, 

RTIME(SENSR( LINKS (LP) ) , J(H) ,3) ,TH2 , TH1 , IEST) 

A2  =  CPHLOC( LINKS (LP) ,3) 

PI  =  DSQRT(  (XS(LP,1)-CPHL0C(LINKS(LP) ,1) )**2  + 

(XS(LP,2)-CPHLOC(LINKS(LP) ,2) )**2    ) 
IEST  =  0 

CALL  RAYFIT1(A1,A2,P1,P2,M,VEL,LM,DZ,V0,V1, 

RTIME(SENSR( LINKS (LP) ) , J(H) ,4) , TH2 , TH1 , IEST) 

IF(M0D(LP,3) .EQ.O)  H=  H+l 


2  5  CONTINUE 
30  CONTINUE 
RETURN 

END 
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*********************************************************************** 

SUBROUTINE  SETUP (DVP , EXT, RTIME , RSHIFT , RSENSR, RLINKS , RJ , RDATA, 
&  RERRTAB, RXS, RXL, RNR, ROB J) 


THIS  SUBROUTINE  TAKES  TRANSIT  TIMES  AND  DVP  INFORMATION  FOR  THE 
RANGE  AND  GENERATES  THE  RANGE  ARRAYS  RSENSR, RLINKS , RJ  AND  RDATA, 
RERRTAB  FOR  INPUT  INTO  THE  RANGE  CONTROL  PROGRAM. 


*  INPUTS: 

*  DVP 

*  EXT 

*  RTIME 
* 
* 

*  RSHIFT 


THE  DVP  PROFILE  CURRENTLY  IN  USE 

DVP  EXTRAPOLATION  CONTROL  (2=  DO  NOT  EXTRAPOLATE  DVP) 

ARRAY  HOUSING  THE  TRANSIT  TIMES  FROM  SENSOR  NUMBER 

(FIRST  ELEMENT)  TO  REGION  (SECOND  ELEMENT)  FOR  HYDROPHONES 

X,YZ,C  RESPECTIVELY  (THIRD  ELEMENT) 

ARRAY  HOUSING  SENSOR  REPOSITIONING  INFORMATION  FOR  SENSOR 

(FIRST  ELEMENT)  AND  DIRECTION  X, Y, Z , XTILT, YTILT, ZROT 

RESPECTIVELY  (SECOND  ELEMENT) 

ARRAY  HOUSING  THE  CENTER  SENSOR  AND  ITS  TRIPLE  OVERLAP 

SATELLITES  (FIRST  INDEX  SENSOR,  SECOND  ARRAY  SENSR(I)) 

ARRAY  HOUSING  THE  LINKS (ENSOR)  ARRAY  FOR  EACH  SENSOR 

(FIRST  ELEMENT) 

ARRAY  HOUSING  THE  OVERLAP  REGIONS  ASSOCIATED  WITH  EACH 

SENSOR  (FIRST  INDEX)  STORING  J(I)  ARRAY 

DATA  ARRAY  FOR  RANGE  CONTAINING  PHS , PHL, THS , THL, HS, HL 

(THIRD  INDEX)  ARRAYS  FOR  A  GIVEN  CENTER  ARRAY  (FIRST 
INDEX)  TO  A  GIVEN  REGION  (SECOND  INDEX) 

ARRAY  CONTAINING  THE  ERROR  ARRAYS  THER, PHER, HER, XER, YER, 

ZER  (THIRD  INDEX)  FOR  A  GIVEN  CENTER  ARRAY  (FIRST  INDEX) 

TO  A  GIVEN  REGION  (SECOND  INDEX) 

RANGE  SBL  ARRAY  FOR  THE  GIVEN  CENTER  SENSOR  (FIRST  INDEX) 

TO  A  GIVEN  REGION  (SECOND  INDEX) 

RANGE  LBL  ARRAY  FOR  THE  GIVEN  CENTER  SENSOR  REGION 

(FIRST  INDEX) 

ARRAY  CONTIANING  NUMBER  OF  REGIONS  ASSOCIATED  WITH  EACH 

CENTER  SENSOR 

J. A.  GEMBARSKI 
NPS    03/01/92 

DIMENSION  XP(3) ,YP(3) ,ZP(3) ,CP(3) ,A(3) , HOLD ( 6 ) , 

&  AR ( 3 ) , XPHLOC (7,3), YPHLOC (7,3), ZPHLOC (7,3), CPHLOC (7,3), 

&  XS(18,3) ,XL(6,3) ,X(3) , TIME (18, 4) , 

&  L(300) ,VEL(300) ,V0(300) , VI ( 300 ) , LM ( 300 ) , 

&  DZ(300) , SHIFT (7, 6) , RSHIFT (0 : 57 , 6 ) , LINKS (18) , 

&  NEW(3) , THL (18) ,HS(18) ,SENSR(7) , J (6) , 

&  THS (18) ,HL(18) , PHS (18) , PHL (18) , ERROR (7, 6) , 

&  RTIME (0:57, 2 7, 4) , RSENSR ( 0 : 57 , 7 ) , RLINKS ( 0 : 57 , 18 ) , 

&  RJ(0:57,6) , RDATA ( 0 : 57 , 27 , 6 ) , RERRTAB ( 0: 57 , 27 , 6 ) , 

&  RXS(0:57,2  7,3) ,RXL(27,3) ,RNR(0:57) ,ROBJ(0:57) 

COMMON  /SET1/  L, VEL, V0 , VI , DZ , LM, M 

INTEGER    SENSR, J, ERR, K, NR, H, KK, N, M, AR, LINKS , NSBL, S, 
+  LP , MP , EXT , I , DVP , RJ , RLINKS , RSENSR , RNR 


OUTPUTS: 
RSENSR 

RLINKS 

RJ 

RDATA 

RERRTAB 

RXS 
RXL 
RNR 


DOUBLE  PRECISION 
DOUBLE  PRECISION 
DOUBLE  PRECISION 
DOUBLE  PRECISION 


XS , XL , XPHLOC , YPHLOC , ZPHLOC , CPHLOC , X , A 

XP, YP,ZP,CP,V0, VI, LM,L, VEL, DZ, RTIME, RSHIFT 

NEW , THL , HOLD , RXS , RXL , RERRTAB , RDATA 

TIME , PHS , PHL , HL , HS , THS , SHIFT , ERROR , ROB J , W 


LOGICAL 


TEST 


69 


CHARACTER* 15  NAME1 

* 

ERR  =  0 

* 

C  RETRIEVE  THE  VELOCITY  PROFILE  INFORMATION 

* 

IF ( EXT. NE. 2) EXT  =  0 

CALL  VELPRO( 1, NAME 1,DVP, EXT, A2 ) 

C         S  =  15 

DO  50  S=0,57 

DO  111  1=1,7 

SENSR(I)  =  -1.0 
111    CONTINUE 

SENSR(l)  =  S 

* 

C      FIND  THE  CORRESPONDING  OVERLAP  REGIONS  AND  ADJACENT  ARRAYS 

C  IF  NONE  EXIST  SKIP  THIS  S(ENSOR) 

* 

CALL  FINDOVR(S, J, ERR) 
IF(ERR.EQ.l)  THEN 
ROBJ(S)  =  -1.0D0 
GOTO  50 
ENDIF 

NR  =  1 

DO  10  LP  =  1,6 

IF(J(LP) .NE.O)  NR=NR+1 

10  CONTINUE 

NR  =  NR-1 
RNR(S)  =  NR 

DO  51  I  =1,6 

R  J  (  S  ,  I )  =  J  ( I ) 

51     CONTINUE 

H=l 
K=l 
KK=2 
N=l 

12  IF( J(K) .NE.0)THEN 
LINKS(N)=1 
CALL  OVERLAP ( J ( K ) , AR , ERR ) 

DO  13  LP=1,3 
MP=1 

11  IF(SENSR(MP) .NE.AR(LP) )THEN 

TEST=.TRUE. 

MP=MP+1 
ELSE 

TEST=. FALSE. 
ENDIF 
IF (TEST. AND.  MP.LT.KK)  GOTO  11 

IF (TEST) THEN 

SENSR(KK)=AR(LP) 
LINKS (N+H)=KK 
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13 


KK=KK+1 

H=H+1 
ELSEIF(SENSR(1) .NE.AR(LP) ) THEN 

LINKS (N+H)=MP 

H=H+1 
ENDIF 
CONTINUE 
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H=l 

K=K+1 

N=N+3 

IF(K.LE.6)  GOTO  12 
ENDIF 
DO  52  I  =  1,18 

RLINKS(S,I)  =  LINKS(I) 
CONTINUE 
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DO  53  I  =1,7 

IF(SENSR(I) .EQ.-l)  GOTO  53 
RSENSR(S,I)  =  SENSR(I) 

CONTINUE 


FIND  THE  NUMBER  OF  SHORT  BASE  LINE  POSLOC  NSBL 


C 

c 
c 
c 
c 
c 
c 
c 
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NSBL  =  N-l 

WRITE(90, 202) 

DO  40  1=1, 18 

IF ( I. LE. 6) WRITE (90, 2 03) I , SENSR ( I ) , J(I) ,LINKS(I) ,LINKR(I) 
IF(I.EQ.7)WRITE(90,204)I,SENSR(I) ,LINKS(I) ,LINKR(I) 
IF(I.LE.12.AND.I.GT.7)WRITE(90,205)I,LINKS(I) ,LINKR(I) 
IF(I.GT.12)WRITE(90,2  06)I,LINKS(I) 

CONTINUE 

CLOSE(UNIT=90) 


ESTABLISH  INDUCED  ERRORS  FOR  THE  CENTER  AND  SATELLITE  ARRAYS 


DO  9  1=1,7 

CALL  RERROR(SENSR(I) , HOLD, ERR) 

DO  8  H  =  1,6 

ERROR ( I, H)   =  HOLD(H) 

CONTINUE 
CONTINUE 


RETRIEVE  THE  ARRAY  SHIFT  INFORMATION  FOR  PREVIOUS  SHIFTS 

DO  7  1=1,7 

DO  6  H  =  1,6 

SHIFT(I,H)  =  RSHIFT(SENSR(I) ,H) 

6  CONTINUE 

7  CONTINUE 
K  =  1 

DO  54  I  =1,18 

IF(LINKS(I).EQ.O)  GOTO  54 
DO  55  H  =  1,4 
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TIME(I,H)  =  RTIME(SENSR(LINKS(I) ) , J(K) ,H) 
55        CONTINUE 

IF(MOD(I,3) .EQ.O)  K  =  K+l 
54     CONTINUE 

* 

*    PERFORM  ARRAY  SHIFTS  FOR  ALL  SBL  POSLOCS 

• 

K  =  1 

DO  77  I  =1,NSBL 

CALL  ARRAY ( SENSR(LINKS ( I ) ),X(1),X(2),X(3),A(1),A(2),A(3) ,ERR) 

X(l)  =  X(l)  +  ERROR ( LINKS(I) ,1)  +  SHIFT(LINKS ( I ) , 1 ) 
X(2)  =  X(2)  +  ERROR (LINKS(I) ,2)  +  SHIFT(LINKS ( I ) , 2 ) 
X(3)  =  X(3)  +  ERROR(LINKS(I) ,3)  +  SHIFT (LINKS ( I ), 3 ) 

A(l)  =  A(l)  +  ERROR (LINKS(I) ,4)  +  SHIFT(LINKS ( I ) , 4 ) 
A(2)  =  A(2)  +  ERROR (LINKS(I) ,5)  +  SHIFT (LINKS ( I ), 5 ) 
A(3)  =  A(3)  +  ERROR (LINKS(I) ,6)  +  SHIFT (LINKS ( I ), 6) 

LP=  LINKS(I) 

CALL  GLOBE(X,A,XP,YP, ZP,CP) 

DO  32  N=l,3 

XPHLOC(LP,N)=XP(N) 
YPHLOC(LP,N)=YP(N) 
ZPHLOC(LP,N)=ZP(N) 
CPHLOC(LP,N)=CP(N) 
32     CONTINUE 

IF (ERROR (LINKS (I ) , 3) .GT.O)  THEN 

IF(EXT.NE.2)EXT  =  1 

CALL  VELPRO ( 0 , NAME 1 , DVP , EXT , X ( 3 ) ) 
ENDIF 

CALL  SHIFTER(X(3) ,A(1),A(2),A(3) , TIME , I , NEW, HS ( I ) , THS ( I ) ) 

XS(I,1)  =  CPHLOC(LINKS(I) , 1)  +  NEW ( 1 ) 
XS(I,2)  =  CPHLOC(LINKS(I ) ,2)  +  NEW ( 2 ) 
XS(I,3)  =  NEW(3) 

IF(MOD(I,3) .EQ.O) THEN 

CALL  LONG ( TIME , LINKS , SENSR , CPHLOC , K , XS , HS , THS , THL , PHS , PHL , HL , 
&  XL) 

K=K+1 

ENDIF 

77    CONTINUE 

* 

C  BUILD  THE  RANGE  ARRAYS 

* 

K  =  1 

DO  60  I  =  1,NSBL 

RDATA ( SENSR (LINKS(I) ) , J(K) , 1)  =  THS ( I ) 

RDATA ( SENSR (LINKS ( I ) 

RDATA ( SENSR (LINKS ( I ) 

RDATA ( SENSR (LINKS ( I ) 

RDATA ( SENSR (LINKS ( I ) 

RDATA ( SENSR (LINKS ( I ) 


,J(K),2)  =  THL(I) 

,J(K),3)  =  PHS(I) 

,J(K),4)  =  PHL(I) 

,J(K),5)  =  HS(I) 


. ,J(K),6)  =   HL(I) 
RXS( SENSR (LINKS(I) ) , J(K) , 1)    =   XS ( I , 1 ) 
RXS(SENSR(LINKS(I) ) , J(K) ,2)    =   XS ( I , 2 ) 
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RXS(SENSR(LINKS(I) ),J(K),3)    =   XS ( I , 3 ) 

RERRTAB(SENSR(LINKS(I) ) , J(K) ,1)  =  THL ( I )  -  THS ( I ) 

RERRTAB(SENSR(LINKS(I) ) , J(K) ,2)  =  PHL ( I )  -  PHS ( I ) 

RERRTAB(SENSR(LINKS(I) ) , J(K) ,3)  =   HL ( I )  -   HS ( I ) 

RERRTAB(SENSR(LINKS(I) ) ,J(K) ,4)  =   XL(K,1)    -   XS ( I , 1 ) 

RERRTAB(SENSR(LINKS(I) ) , J(K) ,5)  =   XL(K,2)    -   XS ( I , 2 ) 

RERRTAB(SENSR(LINKS(I) ) , J(K) ,6)  =   XL(K,3)    -   XS ( I , 3 ) 
IF(M0D(I,3) .EQ.O)  K  =  K+l 

60  CONTINUE 

DO  61  K  =  1,NR 

RXL(J(K),1)  =  XL(K,1) 
RXL(J(K),2)  =  XL(K,2) 
RXL(J(K),3)      =   XL(K,3) 

61  CONTINUE 

W  =  0.0D0 

DO  62  1=1, NR 

W  =  W  +  DSQRT(  (XL(I,3)   -XS ( 3*1-2 , 3 ) ) **2  + 
&  (HL(3*I-2)-HS(3*I-2) )**2  + 

&  (HS (3*1-2)* (PHL (3* 1-2) -PHS (3* 1-2) ) ) **2) 

62  CONTINUE 

ROBJ(S)  =  W/REAL(NR) 

50  CONTINUE 

* 

RETURN 
END 
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APPENDIX  C:   COMPUTER  PROGRAMS  ERRFIX  AND  ANNEAL  (AND  SUPPORT  PROGRAMS) 

Included  with  the  FORTRAN  programs  ERRFIX  and  ANNEAL  are  the 
supporting  programs  NEWTILT  and  NEWERR.  NEWTILT  is  the  tilt  correction 
subcomponent  of  ERRFIX.  NEWERR  is  a  subroutine  designed  to  calculate  the 
new  error  values  from  a  SHIFT  and  output  them  if  desired. 


SUBROUTINE  ERRFIX ( TIME , J , LINKS , SENSR, DVP , EXT , NR, ORIGIN, XS , XL , THS , 
&  THL,PHS,PHL,HS,HL, SHIFT, ERROR) 

THIS  SUBROUTINE  IS  THE  ARRAY  POSITION  (SHIFT  1,2,3)  AND  ORIENTATION 
(SHIFT  4,5,6)  CORRECTION  ALOGRITHM,  MINIMIZING  SBL  AND  LBL  POSLOCS . 


* 

INPUTS: 

* 

XS    : 

+ 

XL    : 

* 

THS   : 

* 

THL   : 

* 

PHS   : 

* 

PHL   : 

* 

HS    : 

* 

HL    : 

* 

SHIFT: 

* 

» 

* 

ERROR: 

* 

* 

* 

OUTPUTS: 

* 

SHIFT: 

* 

* 

TIME, J 

* 

* 

XS,XL, 

» 

* 

SBL  POSLOCS 

LBL  POSLOCS 

SBL  ELEVATION  ANGLES  FROM  C  PHONE 

LBL  ELEVATION  ANGLES  FROM  C  PHONE 

SBL  AZIMUTHS 

LBL  AZIMUTHS 

SBL  HORIZONTAL  DISTANCES  FROM  C  PHONE 

LBL  HORIZONTAL  DISTANCES  FROM  C  PHONE 

CORRECTIONS  APPLIED  TO  CENTER  ARRAY  A.C.  PREVIOUSLY 

X,Y,Z  ARE  THE  1,2,3  ELEMENTS  ; 4 , 5 , 6  IDENTIFY  THE  TILTS 

(XTILT,YTILT,ZROT) 

THE  INDUCED  ERRORS  TO  THE  SENSOR  POSITIONS  (GIVING 

OPERATIONAL  POSITIONS)  FIRST  INDEX  CORRESPONDS  TO  SENSR(I) 

THE  SECOND  TO  THE  TYPE  ( X, Y , Z , XTILT , YTILT, ZROT ) 

X,Y,Z  MOVEMENT  (FEET)  TO  BE  APPLIED  TO  ARRAY  A.C. 
XTILT, YTILT, ZROT  CORRECTIONS  (RADIANS)  TO  BE  APPLIED 
, LINKS, SENSR, DVP, EXT, NR, ORIGIN   :  SENSOR  ARRAY  DATA 

RECEIVED  FROM  FORTRAN  PROGRAM  CONTROL 
PHS, PHL, THS, THL  :  UPDATED  VALUES  OF  THESE  VECTORS 

J. A.  GEMBARSKI 
NPS    03/01/92 


DIMENSION  XS(18,3) ,XL(6,3) , THS (18) , THL (18) , PHS (18) , 
&  PHL (18) ,HS(18) ,HL(18) , SHI FT (7, 6) ,SENSR(7) , 

&  THER ( 6 ) , PHER ( 6 ) , HER ( 6 ) , XER ( 6 ) , YER ( 6 ) , ZER ( 6 ) , CPH (7,3), 

&  XPH (7,3), YPH (7,3), ZPH (7,3), TIME ( 18 , 4 ) , J ( 6 ) , LINKS ( 18 ) , 

&  L(300) ,VEL(300) , V0 ( 300 ) , VI ( 300 ) , DZ ( 300 ) ,LM(300) , 

&  ORIGIN (6,3), ERROR (7,6),X(3),A(3), HOLD (7,6) 


74 


COMMON  /SET1/  L, VEL, VO, VI , DZ , LM,M 

* 

DOUBLE  PRECISION   XS, XL, THS, THL, PHS, PHL, HS, HL, TIME, SHIFT, TUNE1 , 

&  PHER,THER,HER,XER,YER,ZER,MI,MA,SUM,L,VEL,VO,Vl,DZ,LM, 

&  ORIGIN, X , A, CPH, ZFIX, XPH, YPH , ZPH , ERX , ERY , EPS , TUNE , ERROR, 

&  TUNE2,TUNE3,W,OBJ,HOLD 
* 

INTEGER  J , LINKS , SENSR , NR, EXT , I , M, DVP , C , HC , BAD 
* 

LOGICAL  CHECK1 

OBJ  =  500. 0D0 

BAD  =  0 

C  =  0 

DO  29  1=1,6 

HOLD (1,1)  =  0.0D0 

29  CONTINUE 
* 

C  UPDATE  POSITIONS  OF  C  PHONES  FROM  PREVIOUS  SHIFTS 

* 

CALL  UPDATE ( SENSR , DVP , EXT , SH I FT , ERROR , CPH , XPH , YPH , ZPH , X , A ) 
CALL  NEWERR ( C , TIME , J , LINKS , SENSR , ERROR , SHIFT , DVP , EXT , NR , ORIGIN , 
&  THER , PHER , HER , XER , YER , ZER , XS , XL , THS , THL , PHS , PHL , HS , HL ) 

* 

C  FORM  ERROR  ARRAYS 

* 

DO  30  1=1, NR 

THER(I)  =  THL((3*I)-2)  -  THS((3*I)-2) 
PHER(I)  =  PHL((3*I)-2)  -  PHS((3*I)-2) 
HER(I)  =   HL((3*I)-2)  -   HS((3*I)-2) 
XER(I)  =   XL(I,1)  -  XS( (3*I)-2, 1) 
YER(I)  =   XL(I,2)  -  XS( (3*I)-2,2) 
ZER(I)  =   XL(I,3)  -  XS( (3*I)-2,3) 

30  CONTINUE 

CHECK1  =  .FALSE. 

222   CONTINUE 

* 

C  ZROT  CORRECTIONS 

* 

CALL  FIND ( PHER, NR, MI, MA) 

IF(MA.LT.O  .OR.  MI.GT.O)  THEN 
SUM  =0.0 
DO  40  1=1, NR 

SUM  =  SUM  +  PHER(I) 
40    CONTINUE 

SHIFT(1,6)  =  SHIFT(1,6)  -  ( SUM/ REAL (NR) ) 

CALL  NEWERR (C, TIME, J, LINKS, SENSR, ERROR, SHIFT, DVP, EXT, NR, ORIGIN, 
&  THER , PHER , HER , XER , YER , ZER , XS , XL , THS , THL , PHS , PHL , HS , HL ) 

CHECK1  =  .TRUE. 
W  =  0.0D0 
DO  80  I  =1,NR 

W  =  W+  DSQRT(ZER(I)**2  +  HER(I)**2  +  (HS ( 3*1-2 ) *PHER( I ) ) **2 ) 
80    CONTINUE 

W  =  W/REAL(NR) 
GOTO  222 
ENDIF 
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* 

C  DEPTH  CORRECTION  FROM  ELEVATION  ANGLE  ANALYSIS 

* 

IF(NR.EQ.6)THEN 

ZFIX  =  0.0 

CALL  FIND(THER,NR,MI,MA) 

IF(MA.LT.O  .OR.  MI.GT.0)THEN 
SUM  =0.0 
DO  60  1=1, NR 

SUM  =  SUM  +  ZER(I)/(REAL(NR) ) 
60    CONTINUE 

SHIFT (1,3)  =  SHIFT(1,3)  +  SUM 

CALL  FIND(ZER,NR,MI,MA) 
CALL  NEWERR ( C , TIME , J , LINKS , SENSR , ERROR , SHIFT , DVP , EXT , NR , ORIGIN , 
&  THER, PHER, HER, XER, YER, ZER, XS , XL, THS , THL, PHS , PHL, HS , HL ) 

CHECK1  =  .TRUE. 
W  =  0.0D0 
DO  81  I  =1,NR 

W  =  W+  DSQRT(ZER(I) **2  +  HER(I)**2  +  ( HS ( 3* 1-2 ) *PHER ( I ) ) **2 ) 

81  CONTINUE 

W  =  W/REAL(NR) 
GOTO  222 
ENDIF 

ENDIF 

* 

C  ADJUST  XTILT  AND  YTILT  FOR  THETA  ERRORS 

* 

IF(C.EQ.0.AND.CHECK1  .OR.  CHECK1 )  THEN 

CALL  NEWT I LT ( SENSR , DVP , EXT , PHL , THL , PHS , THS , NR , SH I FT , ERX , ERY , 
&  ERROR ) 

SHIFT(1,4)  =  SHIFT(1,4)  +  ERX 
SHIFT(1,5)  =  SHIFT(1,5)  +  ERY 

CALL  NEWERR ( C , TIME , J , LINKS , SENSR, ERROR, SHIFT, DVP , EXT, NR, ORIGIN, 
&  THER , PHER , HER, XER, YER, ZER, XS , XL , THS , THL , PHS , PHL , HS , HL ) 

CHECK1  =  .FALSE. 
W  =  0.0D0 
DO  82  I  =1,NR 

W  =  W+  DSQRT(ZER(I)**2  +  HER(I)**2  +  (HS ( 3*1-2 ) *PHER( I ) ) **2 ) 

82  CONTINUE 

W  =  W/REAL(NR) 
IF(W.LE.OBJ)  THEN 
OBJ  =  W 
DO  182  1=1,6 
HC  =  C 

HOLD (1,1)  =  SHIFT(1,I) 
182      CONTINUE 
BAD  =  0 
ELSE 

BAD  =  BAD  +  1 
ENDIF 

IF(BAD.GT.5)  GOTO  444 
ENDIF 


TUNE  =  (C+1.0)/6.0 
IF(C.GE.15)  TUNE  =  3.0D0 
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C  LOOK  FOR  CONSISTENT  Y  CORRECTIONS 

* __— 


CALL  FIND(YER,NR,MI,MA) 
IF(MA.LT.O  .OR.  MI.GT.O)THEN 
SUM  =0.0 
DO  63  I  =1,NR 

SUM  =  SUM  +  YER(I)/(REAL(NR) ) 
63    CONTINUE 

TUNE1  =  TUNE 
SHIFT (1,2)  =  SHIFT(1,2)  +  SUM*TUNE1 
CALL  NEWERR (C, TIME, J, LINKS, SENSR, ERROR, SHIFT, DVP, EXT, NR, ORIGIN, 
&  THER, PHER, HER, XER, YER, ZER, XS, XL, THS , THL, PHS, PHL, HS, HL) 

CHECK1  =  .TRUE. 
W  =  0.0D0 
DO  83  I  =1,NR 

W  =  W+  DSQRT(ZER(I) **2  +  HER(I)**2  +  (HS ( 3*1-2 ) *PHER( I ) ) **2 ) 
83    CONTINUE 

W  =  W/REAL(NR) 
GOTO  222 
ENDIF 


C  LOOK  FOR  CONSISTENT  X  CORRECTIONS 

* 

CALL  FIND(XER,NR,MI,MA) 
IF(MA.LT.O  .OR.  MI.GT.0)THEN 
SUM  =  0.0 
DO  64  I  =1,NR 

SUM  =  SUM  +  XER(I)/(REAL(NR) ) 
64    CONTINUE 

TUNE2  =  TUNE 
SHIFT(1,1)  =  SHIFT(1,1)  +  SUM  *  TUNE2 
CALL  NEWERR (C, TIME, J, LINKS, SENSR, ERROR, SHIFT, DVP, EXT, NR, ORIGIN, 
&  THER, PHER, HER, XER, YER, ZER, XS , XL, THS, THL, PHS, PHL, HS , HL ) 

CHECK1  =  .TRUE. 
W  =  0.0D0 
DO  84  I  =1,NR 

W  =  W+  DSQRT(ZER(I)**2  +  HER(I)**2  +  ( HS ( 3*1-2 ) *PHER( I ) ) **2 ) 
84    CONTINUE 

W  =  W/REAL(NR) 
GOTO  222 
ENDIF 


C  LOOK  FOR  CONSISTENT  Z  CORRECTIONS 

* 

CALL  FIND(ZER,NR,MI,MA) 
IF(MA.LT.O  .OR.  MI.GT.O)THEN 
SUM  =0.0 
DO  65  I  =1,NR 

SUM  =  SUM  +  ZER(I)/(REAL(NR) ) 
65     CONTINUE 

TUNE3  =  TUNE* 1.5 
SHIFT(1,3)  =  SHIFT(1,3)  +  SUM  *  TUNE3 
CALL  NEWERR (C, TIME, J, LINKS, SENSR, ERROR, SHIFT, DVP, EXT, NR, ORIGIN, 
&  THER, PHER, HER, XER, YER, ZER ,XS, XL, THS, THL, PHS, PHL, HS,HL) 

CHECK1  =  .TRUE. 
W  =  0.0D0 
DO  85  I  =1,NR 

W  =  W+  DSQRT(ZER(I)**2  +  HER(I)**2  +  (HS ( 3*1-2 ) *PHER( I ) ) **2 ) 
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85    CONTINUE 

W  =  W/REAL(NR) 
GOTO  222 
END  IF 


C  LOOK  FOR  Y  CORRECTIONS 

* 


SUM  =0.0 

DO  66  I  =1,NR 

SUM  =  SUM  +  YER(I)/(REAL(NR) ) 
66    CONTINUE 

TUNE1  =  TUNE 
SHIFT(1,2)  =  SHIFT(1,2)  +  SUM*TUNE1 
CALL  NEWERR (C, TIME, J, LINKS, SENSR, ERROR, SHIFT, DVP, EXT, NR, ORIGIN, 
&  THER , PHER , HER , XER , YER , ZER , XS , XL , THS , THL , PHS , PHL , HS , HL ) 

W  =  0.0D0 
DO  86  I  =1,NR 

W  =  W+  DSQRT(ZER(I)**2  +  HER(I)**2  +  (HS ( 3*1-2 ) *PHER( I ) ) **2 ) 
86    CONTINUE 

W  =  W/REAL(NR) 


LOOK  FOR  X  CORRECTIONS 


SUM  =0.0 

DO  67  I  =1,NR 

SUM  =  SUM  +  XER(I)/(REAL(NR) ) 
67    CONTINUE 

TUNE2  =  TUNE 
SHIFT (1,1)  =  SHIFT (1,1)  +  SUM  *  TUNE2 
CALL  NEWERR (C, TIME, J, LINKS, SENSR, ERROR, SHI FT, DVP, EXT, NR, ORIGIN, 
&  THER , PHER , HER, XER, YER, ZER, XS , XL , THS , THL , PHS , PHL , HS , HL ) 

W  =  0.0D0 
DO  87  I  =1,NR 

W  =  W+  DSQRT(ZER(I) **2  +  HER(I)**2  +  (HS ( 3*1-2 ) *PHER( I ) ) **2 ) 
87    CONTINUE 

W  =  W/REAL(NR) 


LOOK  FOR  Z  CORRECTIONS 


SUM  =  0.0 

DO  68  I  =1,NR 

SUM  =  SUM  +  ZER(I)/(REAL(NR) ) 
68     CONTINUE 

TUNE3  =  TUNE 
SHIFT (1,3)  =  SHIFT (1,3)  +  SUM  *  TUNE3 
CALL  NEWERR ( C , TIME , J , LINKS , SENSR , ERROR , SHI FT , DVP , EXT , NR , ORIGIN , 
&  THER , PHER , HER , XER , YER , ZER , XS , XL , THS , THL , PHS , PHL , HS , HL ) 

CHECK1  =  .TRUE. 
W  =  0.0D0 
DO  88  I  =1,NR 

W  =  W+  DSQRT(ZER(I)**2  +  HER(I)**2  +  (HS ( 3*1-2 ) *PHER( I ) ) **2 ) 
88    CONTINUE 

W  =  W/REAL(NR) 


C  =  C  +  1 

IF(C.LT.60  .AND.  BAD . LE . 5 ) GOTO  222 

444  WRITE(92,*) 

WRITE  (92,  *)  'C  ,C,  'BAD'  ,  BAD 
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555 


WRITE (92, 500) SHIFT (1,1) , SHIFT (1,2) , SHIFT (1,3) 
WRITE (92,501) SHIFT (1,4), SHIFT (1,5), SHIFT (1,6) 
WRITE (92,*)  HC 

WRITE ( 92 , 502 ) HOLD (1,1), HOLD (1,2), HOLD (1,3) 
WRITE ( 92 , 503 ) HOLD (1,4), HOLD (1,5), HOLD (1,6) 
DO  555  1=1,6 

SHIFT(1,I)  =  HOLD (1,1) 
CONTINUE 


500  FORMAT (10X,  'PS11  '  , 2X, F9 . 5 , 2X,  ' PS12  ' , F9 . 5 , 2X,  ' PS13  ',F9.5) 

501  FORMAT  (10X,  'ASH  ■  ,  2X,  F9  .  5  ,  2X,  '  AS12  '  ,  F9  .  5  ,  2X,  '  AS13  '  ,  F9  .  5  ) 

502  FORMAT ( 10X, ' HS 11  ' , 2X, F9 . 5 , 2X, ■ HS12  ' , F9 . 5 , 2X, ' HS13  ' , F9 . 5 ) 

503  FORMAT ( 10X, 'HSll  ' , 2X, F9 . 5 , 2X, ' HS12  ' , F9 . 5 , 2X, ' HS13  ',F9.5) 


RETURN 
END 


*************************************************************** 

SUBROUTINE  ANNEAL (TIME , J , LINKS , SENSR, DVP , EXT , NR, ORIGIN , XS , XL , THS , 
&  THL , PHS , PHL , HS , HL , SHI FT , ERROR , WMIN ) 

* 

*  THIS  SUBROUTINE  IS  THE  ARRAY  POSITION  (SHIFT  1,2,3)  AND  ORIENTATION 

*  (SHIFT  4,5,6)  CORRECTION  ALOGRITHM,  MINIMIZING  SBL  AND  LBL  POSLOCS 

*  USING  SIMULATED  ANNEALING. 


INPUTS: 

XS    :  SBL  POSLOCS 

XL    :  LBL  POSLOCS 

THS   :  SBL  ELEVATION  ANGLES  FROM  C  PHONE 

THL   :  LBL  ELEVATION  ANGLES  FROM  C  PHONE 

PHS   :  SBL  AZIMUTHS 

PHL   :  LBL  AZIMUTHS 

HS    :  SBL  HORIZONTAL  DISTANCES  FROM  C  PHONE 

HL    :  LBL  HORIZONTAL  DISTANCES  FROM  C  PHONE 

SHIFT:  CORRECTIONS  APPLIED  TO  CENTER  ARRAY  A.C.  PREVIOUSLY 

X,Y,Z  ARE  THE  1,2,3  ELEMENTS  ; 4 , 5 , 6  IDENTIFY  THE  TILTS 

(XTILT,YTILT,ZROT) 
ERROR:  THE  INDUCED  ERRORS  TO  THE  SENSOR  POSITIONS  (GIVING 

OPERATIONAL  POSITIONS)  FIRST  INDEX  CORRESPONDS  TO  SENSR(I) 

THE  SECOND  TO  THE  TYPE  (X, Y, Z , XTILT, YTILT, ZROT) 
WMIN  :  INITIAL  GUESS  TO  THE  MINIMUM  OBJECTIVE  FUNCTION  VALUE 
TIME, J, LINKS, SENSR, DVP, EXT, NR, ORIGIN   :  SENSOR  ARRAY  DATA 

RECEIVED  FROM  FORTRAN  PROGRAM  CONTROL 

OUTPUTS: 

SHIFT:  X,Y,Z  MOVEMENT  (FEET)  TO  BE  APPLIED  TO  ARRAY  A.C. 

XTILT, YTILT, ZROT  CORRECTIONS  (RADIANS)  TO  BE  APPLIED 
XS,XL,PHS,PHL,THS,THL  :  UPDATED  VALUES  OF  THESE  VECTORS 

J. A.  GEMBARSKI 
NPS    03/01/92 


DIMENSION  XS(18,3) , XL ( 6 , 3 ) , THS ( 18 ) , THL (18) , PHS (18) , 
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PHL ( 18 ) , HS ( 18 ) , HL ( 18 ) , SHIFT (7,6), SENSR ( 7 ) , SMHOLD ( 7 ) , 
THER ( 6 ) , PHER ( 6 ) , HER ( 6 ) , XER ( 6 ) , YER ( 6 ) , ZER ( 6 ) , CPH (7,3), 
XPH (7,3), YPH (7,3), ZPH (7,3), TIME ( 18 , 4 ) , J ( 6 ) , LINKS ( 18 ) , 
L(300) ,VEL(300) ,V0(300) , VI ( 300) , DZ ( 300 ) ,LM(300) , 
ORIGIN(6,3) , ERROR (7, 6) ,X(3) ,A(3) , HOLD ( 7 , 6 ) ,Y(6) ,U(6) 

COMMON  /SET1/  L, VEL, VO, VI, DZ, LM,M 


DOUBLE  PRECISION   XS, XL, THS , THL, PHS, PHL, HS, HL, TIME, SHIFT, 
&         PHER, THER, HER, XER , YER , ZER , SUM , L , VEL , VO , VI , DZ , LM, 
&         ORIGIN , X , A , CPH , XPH , YPH , ZPH , EPS , ERROR, SMALL , SMHOLD , 
&         HOLD , W , B , DELR1 , G , WMIN , WO , Wl , U , PI , P , DELR2 , ALPHA , DEL 

REAL     V,Y 


* 

C 

* 
* 
* 
* 
* 
* 
* 
* 
* 
* 
* 
* 


INTEGER  J, LINKS , SENSR, NR, EXT, I , M, DVP , C, BAD, IX , NO, BAD1 

LOGICAL  CHECK1 , CHECK2 , JUMP100 , JUMP200 

PARAMETER  DEFINITION 

IX  SEED  FOR  THE  RANDOM  NUMBER  GENERATORS 
BAD  NUMBER  OF  SELECTED  'WRONG'  STEPS  MADE 
BAD1    NUMBER  OF  STEPS  TRIED  WITHOUT  IMPROVING  ON  THE  SMALLEST 

OBJECTIVE  FUNCTION  FOUND  SO  FAR 
ALPHA   USED  IN  DETERMINING  A  NEW  OBJECTIVE  FUNCTION  VALUE  IF 

WMIN  EQUALED  OF  SURPASSED 
B       MULTIPLIER  FOR  DETERMINATION  OF  PROBABILITY  OF  ACCEPTING 

"WRONG"  STEP 
G       EXPONENT  FOR  INCREMENTAL  OBJECTIVE  FUNCTION  CHANGE   FOR 
DETERMINATION  OF  PROBABILITY  OF  ACCEPTING  'WRONG"  STEP 
POSITIONAL  STEP  SIZE 
ANGULAR  STEP  SIZE 


DELR1   MULTIPLIER  FOR 

DELR2   MULTIPLIER  FOR 

NO  =  6 

PI  =  DACOS(-l.ODO) 

EPS  =  1.0D-4 

BAD  =  0 

BAD1  =  0 

IX  =  16806 

JUMP100  =  .FALSE. 

JUMP200  =  .FALSE. 

ALPHA  =  0.4D0 

B  =   NR*2.5  +  ABS(NR-3) 

DELR1  =  0.011D0 

DELR2  =  7.7D-6 

G  =  1.0D0 

WMIN  =  0.0D0 

C  =  0 

UPDATE  POSITIONS  OF  C  PHONES  FROM  PREVIOUS  SHIFTS 

CALL  UPDATE ( SENSR , DVP , EXT , SHI FT , ERROR , CPH , XPH , YPH , ZPH , X , A ) 

CALL  NEWERR  (C,  TIME,  J,  LINKS  ,'SENSR,  ERROR,  SHIFT,  DVP,  EXT,  NR,  ORIGIN, 
&  THER , PHER , HER , XER , YER , ZER , XS , XL , THS , THL , PHS , PHL , HS , HL ) 


FORM  ERROR  ARRAYS 

DO  10  1=1, NR 

THER(I)  =  THL((3*I)-2)  -  THS((3*I)-2) 
PHER(I)  =  PHL((3*I)-2)  -  PHS((3*I)-2) 
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HER(I)  =   HL((3*I)-2)  -   HS((3*I)-2) 
XER(I)  =   XL (1,1)  -  XS( (3*1) -2,1) 
YER(I)  =   XL(I,2)  -  XS((3*I)-2,2) 
ZER(I)  =   XL (I, 3)  -  XS( (3* I) -2, 3) 
10  CONTINUE 

PRINT*, SHIFT (1,1) , SHIFT (1,2) ,SHIFT(1,3) 
PRINT*, SHIFT ( 1,4) , SHIFT (1,5) ,SHIFT(1,6) 


C  BUILD  HOLD  ARRAY 

* 

DO   9  I  =  1,7 
DO  8  K=l,6 

HOLD(I,K)  =  SHIFT(I,K) 

8  CONTINUE 

9  CONTINUE 

*___ __ 

C   CALCULATE  NEW  ERRORS  TERMS  USING  A  WEIGHTED  CONSENSUS  POSITION 

* 

C  DO  88  I  =  1,NR 

C  IF(DABS(XS(3*I-1,2)-XS(3*I,2) ) .LT.0.01)  THEN 

C  YER(I)  =  (XS(3*I-1,2)+XS(3*I,2) )/2.0  -  XS(3*I-2,2) 

C  CHECK1  =  .TRUE. 

C  ELSE 

C  CHECK1  =  .FALSE. 

C  YER(I)  =  (XS(3*I-1,2)+XS(3*I,2)+XL(I,2) )/3.0  -  XS(3*I-2,2) 

C  ENDIFC 

C  IF(DABS(XS(3*I-1, 1)-XS(3*I, 1) ) .LT.0.01)  THEN 

C  CHECK2  =  .TRUE. 

C  XER(I)  =  (XS(3*I-1,1)+XS(3*I, 1) )/2.0  -  XS(3*I-2,1) 

C  ELSE 

C  CHECK2  =  .FALSE. 

C  XER(I)  =  (XS(3*I-1,1)+XS(3*I,1)+XL(I,1) )/3.0  -  XS(3*I-2,1) 

C  ENDIF 

C  IF(CHECK1  .AND.  CHECK2 )  THEN 

C  HER(I)  =  DSQRT(XER(I)**2  +  YER(I)**2) 

C  ENDIF 

C         IF(DABS(XS(3*I-1, 3)-XS(3*I, 3) ) .LT.0.01)  THEN 

C  ZER(I)  =  (XS(3*I-1,3)+XS(3*I,3) )/2.0  -  XS(3*I-2,3) 

C         ELSE 

C  ZER(I)  =  (XS(3*I-1,3)+XS(3*I,3)+XL(I,3) )/3.0  -  XS(3*I-2,3) 

C         ENDIF 

C  88   CONTINUE 

W  =  0.0D0 

DO  80  I  =1,NR 

W  =  W+  DSQRT(ZER(I)**2+HER(I)**2+(HS(3*I-2)*PHER(I) )**2) 
80    CONTINUE 

WO  =  W/REAL(NR) 

* 

C    CALCULATE  NEW  WMIN  IF  THE  OBJECTIVE  FUNCTION  IS  LESS  THAN  OR  EQUAL 
C      TO  THE  INITIAL  WMIN 

* 

DEL  =  WO-WMIN 
IF(DEL.LT.O.O)  THEN 

WMIN  =  WO  +  ALPHA*DEL 

IF(WMIN.LT.O.O)  WMIN  =  0.0 
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WRITE(91,*) 'NEW  WMIN',WMIN 
ELSEIF(DEL.LE.EPS  .AND.  DEL. GT. 0.0)  THEN 

GOTO  555 
ENDIF 
SMALL  =  W0*2.0 


C  CHOOSE  A  RANDOM  DIRECTION  TO  WALK 

* _ 

60  IF(BAD.GT.30)  GOTO  555 
C        PRINT*, 'WO' ,W0 
C        PRINT*, 'BAD' ,BAD 

CALL  LNORM(IX,Y,NO,1,0) 
SUM  =0.0 

DO  12  I  =  1,6 

SUM  =  SUM  +  ABS(Y(I) ) **2.0D0 

12  CONTINUE 

DO  13  1=1,6 

U(I)  =  Y(I)/SQRT(SUM) 

13  CONTINUE 

DO  14  I  =  1,2 

HOLD(l,I)  =  SHIFT(1,I)  +  DELR1*U(I) 

14  CONTINUE 

HOLD (1,3)  =  SHIFT (1,3)  +  1 . 5*DELR1*U( 3 ) 
DO  24  I  =  4,5 

HOLD(l,I)  =  SHIFT (1,1)  +  DELR2*U(I) 
24    CONTINUE 

HOLD(l,6)  =  SHIFT(1,6)  +  0 . 5*DELR2*U ( 6 ) 

* 

C  CHECK  FOR  VALID  STEPS 

* 

IF(HOLD(l,4) .LT.  (-PI/2.0)  .OR.  HOLD ( 1 , 4 ) .GT. (PI/2 . 0 ) )  GOTO  60 
IF (HOLD (1,5) .LT.  ( -PI/ 2.0)  .OR.  HOLD ( 1 , 5 ) .GT. ( PI/2 . 0 ) )  GOTO  60 
IF(HOLD(l,6) .LT.  (-PI)  .OR.  HOLD ( 1 , 6 ) .GT. (PI ) )  GOTO  60 

CALL  NEWERR ( C , TIME , J , LINKS , SENSR , ERROR , HOLD , DVP , EXT , NR , ORIGIN , 
_  THER , PHER , HER , XER , YER , ZER , XS , XL , THS , THL , PHS , PHL , HS , HL ) 

* 

C   CALCULATE  NEW  ERRORS  TERMS  USING  A  WEIGHTED  CONSENSUS  POSITION 

* 

C  DO  89  I  =  1,NR 

C  IF(DABS(XS(3*I-1,2)-XS(3*I,2) ) .LT.0.01)  THEN 

C  CHECK1  =  .TRUE. 

C  YER(I)  =  (XS(3*I-1,2)+XS(3*I,2) )/2.0  -  XS(3*I-2,2) 

C  ELSE 

C  CHECK1  =  .FALSE. 

C  YER(I)  =  (XS(3*I-1,2)+XS(3*I,2)+XL(I,2) )/3.0  -  XS(3*I-2,2) 

C  ENDIF 

C  IF(DABS(XS(3*I-1, 1)-XS(3*I,1) ) .LT.0.01)  THEN 

C  CHECK2  =  .TRUE. 

C  XER(I)  =  (XS(3*I-1,1)+XS(3*I,1) )/2.0  -  XS(3*I-2,1) 

C  ELSE 

C  CHECK2  =  .FALSE. 

C  XER(I)  =  (XS(3*I-1, 1)+XS(3*I,1)+XL(I,1) )/3.0  -  XS(3*I-2,1) 
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C  ENDIF 

C  IF(CHECK1  .AND.  CHECK2 )  THEN 

C  HER(I)  =  DSQRT(XER(I)**2  +  YER(I)**2) 

C  ENDIF 

C  IF(DABS(XS(3*I-1,3)-XS(3*I,3) ) .LT.0.01)  THEN 

C  ZER(I)  =  (XS(3*I-1,3)+XS(3*I,3) )/2.0  -  XS(3*I-2,3) 

C  ELSE 

C  ZER(I)  =  (XS(3*I-1,3)+XS(3*I,3)+XL(I,3) )/3.0  -  XS(3*I-2,3) 

C  ENDIF 

C  89   CONTINUE 

* 

C    CHANGE  THE  STEP  SIZING  AND  PROBABILITY  CALCULATING  PARAMETERS  IF 

C  NOT  IMPROVING  THE  OBJECTIVE  FUNCTION 

* — 

W  =  0.0D0 

DO  15  I  =  1,NR 

W  =  W+  DSQRT(ZER(I)**2  +  HER(I)**2  +  (HS ( 3*1-2 ) *PHER( I ) ) **2 ) 
15    CONTINUE 

Wl  =  W/REAL(NR) 

DELW  =  Wl  -  WO 

IF ( WO. LE. SMALL  .OR.  Wl . LE . SMALL)  THEN 
BAD1  =  0 

IF(JUMP100  .AND.  .NOT. JUMP2  00)  THEN 

DELR1  =  DELR1/1.5 

DELR2  =  DELR2/1.5 

JUMP100  =  .FALSE. 
ENDIF 

IF(JUMP100  .AND.  JUMP200)  THEN 

B  =  B/1.25 

JUMP100  =  .FALSE. 

JUMP200  =  .FALSE. 
ENDIF 

IF(WO.LE.Wl)  THEN 
DO  18  1=1, NR 

SMHOLD(I)  =  SHIFT(1,I) 

18  CONTINUE 
SMALL  =  WO 

ELSE 

DO  19  1=1, NR 

SMHOLD ( I )  =  HOLD (1,1) 

19  CONTINUE 
SMALL  =  Wl 

ENDIF 
ELSE 

BAD1  =  BAD1  +  1 
ENDIF 
IF(BADl.EQ.lOO)  THEN 

DELR1  =  DELR1*1.5 

DELR2  =  DELR2*1.5 

JUMP100  =  .TRUE. 

PRINT*, ' JUMP100' 
ELSEIF(BAD1.EQ.200)  THEN 

B  =  B*1.25 

JUMP200  =  .TRUE. 

PRINT*, ' JUMP200' 
ENDIF 
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IF(BAD1  .EQ.  2500)  GOTO  555 


DETERMINE  WHETHER  OR  NOT  TO  TAKE  THE  STEP 
IF(Wl.LE.WO)  THEN 


DO  16  I  =  1,6 

SHIFT(1,I)  =  HOLD (1,1) 
16    CONTINUE 


WO  =  Wl 

DEL  =  WO-WMIN 
IF(DEL.LT.O.O)  THEN 

WMIN  =  WO  +  ALPHA*DEL 

IF(WMIN.LT.O.O)  WMIN  =  0.0 
ELSEIF(DEL.LE.EPS  .AND.  DEL. GT. 0.0)  THEN 

GOTO  555 
ENDIF 

C  =  C  +  1 
BAD  =  0 
GOTO  60 

ELSE 

BAD  =  BAD  +1 

G  =  1.0  -  2.0*W0 

IF( (-B*DELW/(W0**G) ) .LT.-50.0)  THEN 

P  =  0.0 
ELSE 

P  =  EXP(-B*DELW/ (W0**G) ) 
ENDIF 

CALL  LRND( IX, V, 1, 1,0) 

IF(V.GE.P)  THEN 

WRITE (91,*) 'TAKE  BAD  STEP' 
C  =  C  +  1 
GOTO  60 
ELSE 

WRITE (91, *) 'TAKE  BAD  STEP ' 
DO  17  I  =  1,6 

SHIFT (1,1)  =  HOLD (1,1) 
17  CONTINUE 

WO  =  Wl 
GOTO  60 
ENDIF 
ENDIF 

555  IF(BAD1.EQ.2500)  THEN 
DO  20  I  =1,NR 

SHIFT (1,1)  =  SMHOLD(I) 
20    CONTINUE 
ENDIF 

WRITE(92,*) 'C ,C, '  BAD1  ',BAD1 
WRITE(92,*) 

WRITE(92,500)SHIFT(1,1) , SHIFT (1,2) , SHIFT (1,3) 
WRITE (9 2, 501) SHI FT (1,4) , SHIFT (1,5) , SHIFT (1,6) 
WRITE(92, *) 


84 


WRITE (92,*)  "SMALLEST  ' , SMALL 

WRITE ( 92 , 500 ) SMHOLD ( 1 ) , SMHOLD ( 2 ) , SMHOLD ( 3 ) 

WRITE (92,501) SMHOLD ( 4 ) , SMHOLD ( 5 ) , SMHOLD ( 6 ) 

500  FORMAT(10X, 'PS11  ' , 2X, F9 . 5 , 2X, ' PS12  ' , F9 . 5 , 2X, ' PS13  ' , F9 . 5 ) 

501  FORMAT  (10X,  'ASH  '  ,  2X,  F9  .  5  ,  2X,  ■  AS12  '  ,  F9  .  5  ,  2X,  '  AS13  '  ,  F9  .  5  ) 


RETURN 
END 


it********************************************************************** 

SUBROUTINE  NEWTILT ( SENSR , DVP , EXT , PHL , THL , PHS , THS , NR , SHIFT , ERX , 
&  ERY, ERROR) 

*  SUBROUTINE  TO  ERRFIX 

*  FIND  NEW  POSITIONS  OF  THE  X  AND  Y  HYDROPHONES  BASED  ON  TWO 

*  TILT  ERRORS,  THOSE  CLOSEST  TO  THE  Y  AND  X  AXIS,  THIS  IS  DONE 

*  BY  FITTING  A  PLANE  THROUGH  THE  NEW  POINTS  ALONG  THE  CHOSEN 

*  AZIMUTHS  AND  THEN  BACKING  OUT  THE  X,Y  HYDROPHONE  POSITIONS 
* 

*  INPUTS: 

*  ERROR  :  ERROR  ARRAY  CONTAINING  INDUCED  ERRORS  TO  THE  CENTER  AND 

*  SATELLITE  SENSORS-FIRST  ELEMENT  CONTROLS  WHICH  SENSOR 

*  THE  SECOND  CONTROLS  CORRECTION  (1-3;  X,Y,Z  4-6;  X,Y,Z 

*  TILTS) 

*  SHIFT  :  ARRAY  CONTAINING  CORRECTIONS  TO  THE  CENTER  AND 

*  SATELLITE  SENSORS-FIRST  ELEMENT  CONTROLS  WHICH  SENSOR 

*  THE  SECOND  CONTROLS  CORRECTION  (1-3;  X,Y,Z  4-6;  X,Y,Z 

*  TILTS) 

*  SENSR  :  VECTOR  DEFINING  SENSOR  ARRAY  NUMBERS 

*  DVP, EXT:  DVP  IDENTIFIER  (FROM  CONTROL  PROGRAM)  AND  EXTRAPOLATION 

*  CONTROL 

*  PHL, PHS, THL, THS  :   LBL  AND  SBL  POSLOC  INFORMATION 

*  NR     :   NUMBER  OF  OVERLAP  REGIONS  FOR  THE  INTERIOR  ARRAY  OF 

*  INTEREST 

*  OUTPUTS: 

*  ERX    :  CORRECTION  TERM  FOR  XTILT  ANGLE  (RADIANS) 

*  ERY    :  CORRECTION  TERM  FOR  YTILT  ANGLE  (RADIANS) 

* 

* 

DIMENSION  PHL (18) , SHIFT (7, 6) ,X(3) ,Y(3) , THL (18) , 
&  CO ( 3 ) , XPH (7,3), YPH (7,3),ZPH(7,3), CPH (7,3), PHS ( 18 ) , 

&  THS (18) , ERROR (7, 6) ,SENSR(7) ,PHER(6) 

DOUBLE  PRECISION  PHL, PI , ZROT, R, HOLD90, SHIFT, HOLDO, D, ERX, 
&  CO , XPH , YPH , ZPH , CPH , X , Y , YTI LTL , XTI LTL , A , B , C , E , ERY , 
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&  XHX , YHX , ZHX , XHY , YHY , ZHY , THL , PHS , THS , XTILTS , 

&  YTILTS,ERROR,PHER,MA,MI 

INTEGER   MARK9  0 , 1 , NR , MARKO , EXT , SENSR , DVP , K 

CALL  UPDATE ( SENSR , DVP , EXT , SHI FT , ERROR , CPH , XPH , YPH , ZPH , X , Y ) 
ZROT  =  Y(3) 
D  =  30.0D0 
PI  =  DACOS(-l.ODO) 
MARK90  =  0 
HOLD90  =  5.0*PI/6.0 
MARKO   =  0 
HOLDO   =  5.0*PI/6.0 
* 

C        FIND  POSLOC  REGIONS  CLOSEST  TO  0  AND  90  DEGREES  (RANGE) 

* —  — 

DO  10  I=1,NR 

IF ( DABS ( PHL (3*1-2) +ZROT ) . LE . PI ) THEN 

R  =  PHL(3*I-2)  +  ZROT 
ELSE IF ( ZROT . GT . 0 . 0 ) THEN 

R  =  PHL(3*I-2)  +  ZROT  -  2.0*PI 
ELSE 

R  =  2.0*PI  +  PHL(3*I-2)  +  ZROT 
ENDIF 

IF ( DABS ( R-PI /2 . 0 ) . LT . HOLD90 ) THEN 

HOLD90  =  DABS(R-PI/2.0) 

MARK90  =  I 
ENDIF 
IF(DABS(R) .LT. HOLDO) THEN 

HOLDO  =  DABS(R) 

MARKO  =  I 
ENDIF 

10  CONTINUE 

IF (MARK90.EQ. MARKO  .AND.  NR.GT.1)THEN 

IF( (NR-MARK90) .GT.0)THEN 
MARKO  =  MARK90  +  1 

ELSE 

MARKO  -  MARK90  -  1 

ENDIF 
ELSEIF(NR.EQ. 1 ) THEN 

PRINT*,' NOT  ENOUGH  REGIONS  TO  FORM  A  PLANE' 

PRINT*, 'RETURN  FROM  NEWTILT' 

RETURN 
ENDIF 

I F ( MARK90 . EQ . 0 ) THEN 

PRINT*, 'ERROR  IN  Y  AXIS  LOCATION' 

STOP 
ELSEIF ( MARKO. EQ.O) THEN 

PRINT*, 'ERROR  IN  X  AXIS  LOCATION' 

STOP 
ENDIF 

DO  12  1=1,3 

C0(I)  =  CPH(1,I) 
12   CONTINUE 

* 

*  FORM  THE  PLANE  THROUGH  THE  LBL  ANGLES 

* 
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X(l)  =   D*DCOS(PHL(3*MARK90-2) ) 

X(2)  =   D*DSIN(PHL(3*MARK90-2) ) 

X(3)  =  -D*DTAN(THL(3*MARK90-2) ) 

Y(l)  =   D*DCOS(PHL(3*MARK0  -2)) 

Y(2)  =   D*DSIN(PHL(3*MARK0  -2)) 

Y(3)  =  -D*DTAN(THL(3*MARK0  -2)) 


+ 

C0(1) 

+ 

CO  (2) 

+ 

C0(3) 

+ 

CO(l) 

+ 

CO(2) 

+ 

CO(3) 

CALL  PLANE(X,Y,CO,A,B,C,E) 

XHX  =  D*DCOS(-ZROT)  +  CO ( 1 ) 
YHX  =  D*DSIN(-ZROT)  +  C0(2) 
ZHX  =  C0(3)  -  (-E-A*XHX-B*YHX)/C 
XTILTL  =  DASIN(ZHX/D) 

XHY  =  D*DCOS(-ZROT+PI/2.0)  +  CO ( 1 ) 
YHY  =  D*DSIN(-ZROT+PI/2.0)  +  CO ( 2 ) 
ZHY  =  CO(3)  -  (-E-A*XHY-B*YHY)/C 
YTILTL  =  DASIN(ZHY/D) 

FORM  THE  PLANE  THROUGH  THE  SBL  ANGLES 


X(l)  =   D*DCOS(PHS(3*MARK90-2) 

X(2)  =   D*DSIN(PHS(3*MARK90-2) 

X(3)  =  -D*DTAN(THS(3*MARK90-2) 

Y(l)  =   D*DCOS(PHS(3*MARK0  -2) 

Y(2)  =   D*DSIN(PHS(3*MARK0  -2) 

Y(3)  =  -D*DTAN(THS(3*MARK0  -2) 


)    + 

C0(1) 

)    + 

CO  (2) 

)    + 

C0(3) 

)    + 

CO(l) 

)    + 

CO  (2) 

)    + 

C0(3) 

CALL  PLANE(X,Y,CO,A,B,C,E) 

XHX  =  D*DCOS(-ZROT)  +  CO ( 1 ) 
YHX  =  D*DSIN(-ZROT)  +  CO ( 2 ) 
ZHX  =  CO(3)  -  (-E-A*XHX-B*YHX; 
XTILTS  =  DASIN(ZHX/D) 


/C 


XHY  =  D*DCOS(-ZROT+PI/2 .0)  +  CO ( 1 ) 
YHY  =  D*DSIN(-ZROT+PI/2.0)  +  CO ( 2 ) 
ZHY  =  C0(3)  -  (-E-A*XHY-B*YHY)/C 
YTILTS  =  DASIN(ZHY/D) 


ERX  = 
ERY  = 

RETURN 
END 


(XTILTL-XTILTS) 
(YTILTL-YTILTS) 
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*********************************************************************** 

SUBROUTINE  NEWERR ( C , TIME , J , LINKS , SENSR , ERROR , SHI FT , DVP , EXT , NR , 
&  ORIGIN, THER, PHER, HER, XER, YER, ZER, XS , XL, THS , THL, 

&  PHS,PHL,HS,HL) 

* 

*  THIS  SUBROUTINE  PERFORMS  A  SENSOR  SHIFT  FROM  THE  SHIFT  ARRAY 

*  INFORMATION  AND  THEN  CALCULATES  A  NEW  LONGBASE  POSLOC  AND  ERROR 

*  TABLE.  CALLED  FROM  ERRFIX. 

*  INPUTS: 
C      :  OUTPUT  CONTROL  NUMBER,  NUMBER  OF  ITERATIONS  THROUGH 

ERRFIX  SUBROUTINE 
ERROR  :  ERROR  ARRAY  CONTAINING  INDUCED  ERRORS  TO  THE  CENTER  AND 

SATELLITE  SENSORS-FIRST  ELEMENT  CONTROLS  WHICH  SENSOR 

THE  SECOND  CONTROLS  CORRECTION  (1-3;  X,Y,Z  4-6;  X,Y,Z 

TILTS) 
SHIFT  :  ARRAY  CONTAINING  CORRECTIONS  TO  THE  CENTER  AND 

SATELLITE  SENSORS-FIRST  ELEMENT  CONTROLS  WHICH  SENSOR 

THE  SECOND  CONTROLS  CORRECTION  (1-3;  X,Y,Z  4-6;  X,Y,Z 

TILTS) 
TIME,  LINKS,  SENSR,  J:   INDIVIDUAL  ARRAY  VECTORS  AS  DEFINED  IN\ 

SUBROUTINE  SETUP  FOR  THE  NANOOSE  RANGE 
DVP, EXT:  DVP  IDENTIFIER  (FROM  CONTROL  PROGRAM)  AND  EXTRAPOLATION 

CONTROL 

TRUE  TARGET  POSITION,  USED  FOR  COMPARATIVE  ANALYSIS 


ORIGIN 
OUTPUTS: 
THER 
PHER 
HER 
XER 
YER 
ZER 


ELEVATION  ANGLE  ERROR  (LBL  -  SBL) 
AZIMUTH    ANGLE  ERROR  (LBL  -  SBL) 
HORIZONTAL  RANGE  ERROR  (LBL  -  SBL) 
X  COORDINATE  ERROR  (LBL  -  SBL) 
Y  COORDINATE  ERROR  (LBL  -  SBL) 
Z  COORDINATE  ERROR  (LBL  -  SBL) 


* 

UPDATED  VALUES  FOR  XS , XL, PHS , PHL , THS , THL , HS , HL 

* 
* 

J. A.  GEMBARSKI 
NPS    01/01/92 

DIMENSION  CPH (7,3), THER ( 6 ) , PHER ( 6 ) , HER ( 6 ) , XER ( 6 ) , 
&  YER(6) ,ZER(6) ,A(3),X(3),XS(18,3),XL(6,3), 

&  THS ( 18 ) , THL ( 18 ) , PHS ( 18 ) , PHL ( 18 ) , HS ( 18 ) , HL ( 18 ) , 

&  NEW(3) , ORIGIN (6, 3) , SHI FT (7, 6) , ERROR (7, 6) ,SENSR(7) , 

&  XPH(7,3) ,YPH(7,3) , ZPH(7,3) , TIME (18, 4) , J(6) , LINKS (18) 


DOUBLE  PRECISION 
DOUBLE  PRECISION 
DOUBLE  PRECISION 
DOUBLE  PRECISION 


CPH, THER, PHER, HER, XER, YER, ZER, A, X, XS 

XPH,YPH,ZPH 

XL , THS , THL , ORIGIN , SHI FT , ERROR 

PHS , PHL , HS , HL , TIME , NEW 


INTEGER    K, J, LINKS, SENSR, NR, EXT, DVP, C 


CALL  UPDATE ( SENSR , DVP , EXT , SHI FT , ERROR , CPH , XPH , YPH , ZPH , X , A ) 

K  =1 

DO  10  I=1,3*NR,3 

CALL  SHIFTER (X(3),A(1),A(2),A(3), TIME , I , NEW, HS ( I ) , THS ( I ) ) 

XS(I,1)  =  CPH(LINKS(I) ,1)  +  NEW(l) 
XS(I,2)  =  CPH(LINKS(I) ,2)  +  NEW(2) 
XS(I,3)  =  NEW(3) 
WRITE (3,*)  'LONG  FROM  NEWERR' 
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CALL  LONG (TIME , LINKS , SENSR, CPH, K, XS , HS , THS , THL, PHS , PHL , 
HL,XL) 


10 


THER( 

PHER( 

HER(K 

XER(K 

YER(K 

ZER(K 

IF(C.GT.16) 

WRITE(91 

WRITE (91 

N  =  (3*K 

WRITE(91,2 

WRITE (91, 2 

WRITE(91,2 

WRITE(91,2 

WRITE (91, 2 

WRITE (91, 2 

WRITE (91, 2 

WRITE(91,2 

WRITE (91, 2 

WRITE(91,2 

ENDIF 

K  =  K  + 
CONTINUE 
IF(C.GT. 14) 


230 
231 
232 
233 
234 
235 
236 
237 
238 
239 
240 
250 
251 
252 
253 
254 
255 


K)  = 
K)  = 
)  = 
)  = 
)  = 
)  = 
THEN 

,*) 

,230)  J(K) 
)-2 
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THL(I)  -  THS(I) 
PHL(I)  -  PHS(I) 
HL(I)  -   HS(I) 
XL(K,1)  -   XS(I,1) 
XL(K,2)  -   XS(I,2) 
XL(K,3)  -   XS(I,3) 


32 
33 
34 

35 
36 
37 
38 
39 
40 


(SENSR(LINKS(MP) ) ,MP=N,N+2) 

XS(N, 1) ,XS(N+1,1) ,XS(N+2,1) ,XL(K,1) , ORIGIN (K,l) 

XS(N,2) ,XS(N+1,2) ,XS(N+2,2) ,XL(K,2) , ORIGIN (K, 2) 

XS(N,3) ,XS(N+l,3),XS(N+2,3) , XL (K, 3 ) , ORIGIN (K, 3 ) 

THS ( N ) , THS ( N+l ) , THS ( N+2 ) 

THL(N) ,THL(N+1) ,THL(N+2) 

PHS(N) , PHS (N+l) , PHS (N+2) 

PHL(N) , PHL (N+l) , PHL (N+2) 

HS(N) ,HS(N+1) ,HS(N+2) 

HL(N) ,HL(N+1) ,HL(N+2) 


WRITE 

WRITE 

WRITE 

WRITE 

WRITE 

WRITE 

WRITE 

WRITE 

WRITE 

WRITE 

WRITE 

WRITE 

WRITE 

WRITE 

WRITE 

ENDIF 

RETURN 

FORMAT 

FORMAT 

FORMAT 

FORMAT 

FORMAT 

FORMAT 

FORMAT 

FORMAT 

FORMAT 

FORMAT 

FORMAT 

FORMAT 

FORMAT 

FORMAT 

FORMAT 

FORMAT 

FORMAT 


(91, 
(91, 
(91, 
(91, 
(91, 
(91, 
(91, 
(91, 
(91, 
(91, 
(91, 
(91, 
(91, 
(91, 
(91, 


THEN 

*) 
250) 

251)  ( J(MP) ,MP=1,NR) 

*) 

252)  (THER(MP) ,MP=1,NR) 

*) 

253)  (PHER(MP) ,MP=1,NR) 

*) 

254)  (HER(MP) ,MP=1,NR) 

*) 

255)  (XER(MP) ,MP=1,NR) 

*) 

256)  (YER(MP) ,MP=1,NR) 

*) 

257)  (ZER(MP) ,MP=1,NR) 


(25X, 
(2X,3 
(IX,  ' 
(IX,' 
(IX,' 
(IX,  • 
(IX,  • 
(IX,  • 
(IX,  • 
(IX,  ' 
(IX,  ' 
(15X, 
(IX,1 
(IX,  • 
(IX,  • 
(IX,  • 

(ix,  • 


12) 

, IX, 12, IX, 
2(7X,F9.2) 
2(7X,F9.2) 
2(7X,F9.2) 
•  ,3X,F8.5,2(8X,F8.5) 
' ,3X,F8.5,2(8X,F8.5) 
' ,3X,F8.5,2(8X,F8.5) 
1 ,3X,F8.5,2(8X,F8.5) 
,4X,F8.2,2(8X,F8.2) , 
,4X,F8.2,2(8X,F8.2) , 


'REGION 

(3X, 'ARRAY 

X1 ,4X,F9.2 

Y' ,4X,F9.2 

Z1 ,4X,F9.2 

THS 

THL 

PHS 

PHL 

HS' 

HL' 

'CENTER  ARRAY  ERROR  ANALYSIS 

REGION1 ,5X,I2,5(8X,I2) ) 

THER' ,2X,6(2X,F8.5) ) 

PHER1 ,2X,6(2X,F8.5) ) 

HER1 ,3X,6(2X,F8.4) ) 

XER1 ,2X,6(2X,F8.3) ) 


SBL  ' ) ,3X, "LONGBASE 
5X,F9.2,3X,F9.2) 
5X,F9.2,3X,F9.2) 
5X,F9.2,3X,F9.2) 


6X, 'GOAL' ) 


,5X,F8.4,3X,F8.4) 
,5X,F8.4,3X,F8.4) 
,5X,F8.4,3X,F8.4) 
,5X,F8.4,3X,F8.4) 
5X,F8.2,3X,F8.2) 
5X,F8.2,3X,F8.2) 
) 
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256  F0RMAT(1X, '  YER ' , 2X, 6 ( 2X, F8 . 3 ) ) 

257  FORMAT(lX, 'ZER' ,2X,6(2X,F8.3) ) 

END 
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APPENDIX  D:   COMPUTER  PROGRAM  CONTROL 

This  is  the  main  driving  program  of  the  error  correction  methodology. 

Additional  control  lines  have  been  added  than  are  presented  in  the 
logic  flow  chart  (Figure  11).  These  control  lines  were  needed  during 
multiple  sensor  array  correction  attempts.  The  nature  of  the  control 
structure  is  to  determine  the  entry  into  ANNEAL.  The  entry  requirements 
into  ANNEAL  have  also  been  changed  (from  objective  function  value  0.5  to 
1.0).  This  enabled  faster  solution  convergence  by  preceding  to  ANNEAL 
quicker. 

PROGRAM  CONTROL 
* 

*  THIS  PROGRAM  CONTROLS  THE  ERROR  CORRECTION  SCHEME  FOR  THE  NANOOSE 

*  RANGE . 

*  A  SIMULATION  START  (SIMSTRT)  SUBROUTINE  GENERATES  TRANSIT  TIMES  FOR 

*  EACH  SENSOR  IN  THE  RANGE  TO  ITS  TRIPLE  OVERLAP  REGIONS  R(ANGE)TIME 

*  (THIS  INFORMATION  IS  NORMALLY  PROVIDED  BY  THE  RANGE). 

*  SENSOR  OPERATIONAL  POSITION  (ERROR  INDUCED  FROM  THE  ACTUAL  POSITION) 

*  IS  CREATED  THROUGH  THE  RANGE  ERROR  (RERROR)  SUBROUTINE.   SENSOR 

*  ACTUAL  POSITION  IS  FOUND  IN  THE  SUBROUTINE  ARRAY. 

*  J. A.  GEMBARSKI 

*  NPS    03/01/92 

* 

DIMENSION  HOLD (  6 )  , XPHLOC (7,3), YPHLOC (7,3), ZPHLOC (7,3), CPHLOC (7,3), 

&  ORIGIN (6, 3) , XS(18,3) ,XL(6,3) , RLINKS ( 0 : 57 , 18 ) , J (6) , 

&  L(300) ,VEL(300) ,V0(300) , VI (300) ,LM(300) , RORIGIN ( 27 , 3 ) , 

&  DZ(300) ,SHIFT(7,6) , RSHIFT ( 0 : 57 , 6 ) ,YER(6) ,ZER(6) , 

&  THL(18) ,HS(18) ,THER(6) , PHER ( 6 ) ,HER(6) ,XER(6) ,SENSR(7) , 

&  THS(18) ,HL(18) ,PHS(18) ,PHL(18) , ERROR (7, 6) , LINKS (18) , 

&  RTIME(0:57,27,4) , RSENSR ( 0 : 57 , 7 ) , TIME (18, 4) , CHECKA( 0 : 57 ) , 

&  RJ(0:57,6) ,RNR(0:57) , RDATA(0 : 57 , 27 , 6 ) ,ROBJ(0:57) ,W1(7) , 

&  RERRTAB(0:57,2  7,6) , RXS ( 0 : 57 , 27 , 3 ) ,RXL(27,3) ,MARK(0:57) 

* 

COMMON  /SET1/  L, VEL, V0, VI , DZ , LM, M 

INTEGER    SENSR, J, ERR, K,NR,H,N,M, LINKS, RJ, RLINKS, RNR, RSENSR, S, 

+  MP,EXT,I,DVP,SS,NRS,MARK,MA 

* 

DOUBLE  PRECISION  ORIGIN, XS , XL, XPHLOC, YPHLOC, ZPHLOC, CPHLOC, XER 

DOUBLE  PRECISION  V0, VI , LM, L, VEL, DZ , RDATA, RERRTAB, THER, YER, ZER 

DOUBLE  PRECISION  THL, HOLD , PHER, HER, RORIGIN, RSHIFT, RTIME, ROBJ 

DOUBLE  PRECISION  TIME , PHS , PHL, HL, HS, THS , SHIFT, ERROR, RXS, RXL,W 

DOUBLE  PRECISION  MAX, TOL, WMIN, Wl 
* 

LOGICAL  CHECKA,CHECKO,MKANN 

*__ 

C  INITIALIZATION 


91 


DO  3  1=1,300 
L(I) 

VEL(I)  = 
V0 ( I )   = 
V1(I)   = 
DZ(I)   = 
LM ( I )   = 
IF(I.LE.5 
CONTINUE 
DATA  THS/18* 
DATA  THL/18* 
DATA  PHS/18* 
DATA  PHL/18* 
DATA  HS/18*0 
DATA  HL/18*0 
DATA  XS/54*0 
DATA  XL/18*0 
DATA  SHIFT/4 
DATA  XPHLOC/ 
DATA  YPHLOC/ 
DATA  ZPHLOC/ 
DATA  CPHLOC/ 
DATA  RSHIFT/ 
DATA  RTIME/6 
DATA  RDATA/9 
DATA  RSENSR/ 
DATA  RORIGIN 
DATA  MARK/ 58 
ERR  =  0 
TOL  =  1.0D-4 
MA  =  58 


0.0 
0.0 
0.0 
0.0 
0.0 
0.0 
8)  CHECKA(I-l)  =  .FALSE 

0/ 
0/ 
0/ 
0/ 

/ 
/ 
/ 
/ 

2*0/ 

21*0/ 

21*0/ 

21*0/ 

21*0/ 

348*0/ 

264*0/ 

396*0/ 

406*-l/ 

/81*0/ 

*0/ 


C  CHOSE  THE  DVP  TO  BE  USED  0 

C  0. 

C  0. 

C  0. 

C  0. 

C  0. 

C  REAL 
DVP  =  10 


ISOSPEED  =  10 

02   ISOGRADIENT  =  11 

04   ISOGRADIENT  =  12 

06   ISOGRADIENT  =  13 

08   ISOGRADIENT  =  14 

083  ISOGRADIENT  =  15 

WATER  COLUMN  =  5 


C   TO  CANCEL  THE  DVP  EXTRAPOLATION  SET  EXT  TO  2 
EXT  =  2 

* 

C      OPEN (UNIT=3,FILE=' /LONG  OUT  A') 

C      OPEN(UNIT=44,FILE=' /REC  METHOD  A') 

C      OPEN(UNIT=90,FILE=' /INFO  TSTR  A1) 

OPEN(UNIT=91,FILE=' /DATA  TSTR  T') 

OPEN (UNIT=92,FILE=' /VALID  BIG  T') 

666  CALL  SIMSTRT(DVP,EXT,RTIME, RORIGIN) 

CALL  SETUP ( DVP , EXT , RTIME , RSHIFT , RSENSR , RLINKS , RJ , RDATA , 
&  RERRTAB,RXS,RXL,RNR,ROBJ) 

MKANN  =  .FALSE. 
999  MAX  =  0.0D0 

CHECKO  =  .TRUE. 
DO  40  I  =  0,57 

IF(ROBJ(I) .EQ.-1.0)  GOTO  40 

IF(ROBJ(I) .GT.5.0D0)  PRINT* ,' CHECK  FOR', I 

IF(ROBJ(I) .GT.1.0  .AND.  .NOT. MKANN  .AND.  RNR( I ) . EQ. 6 )  THEN 
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PRINT*, 'OBJ  PREVENTIN  ANNEAL ' , I , ROB J ( I ) 
CHECKO  =  .FALSE. 
ENDIF 

IF(MA.EQ.I)  GOTO  40 

IF(ROBJ(I) .GE.MAX  .AND.  ROBJ ( I ) . GT. TOL  .AND.  ( RNR ( I ) . EQ. 6 ) ) THEN 
S  =  I 

MAX  =  ROBJ (I) 
ENDIF 
40  CONTINUE 

PRINT*, 'S  IN  CONTROL ',S 
* 

C      RETRIEVE  RANGE  INFORMATION  ARRAYS  FROM  SETUP  SUBROUTINE 

* 

PRINT*, "BEFORE  ERRFIX/ANNEAL ' 
DO  5  I  =  1,7 

SENSR(I)  =  RSENSR(S,I) 

PRINT* , ' OBJ ' , SENSR ( I ) , ROBJ ( SENSR ( I ) ) 

5  CONTINUE 

DO  4  I  =1,18 

LINKS(I)  =  RLINKS(S,I) 
4     CONTINUE 

* 

C     ESTABLISH  INDUCED  ERRORS  FOR  THE  CENTER  AND  SATELLITE  ARRAYS 

* 

DO  9  1=1,7 

IF(SENSR(I) .EQ.-l)  GOTO  9 
CALL  RERROR( SENSR ( I ) , HOLD, ERR) 
DO  8  H  =  1,6 

ERROR ( I, H)  =  HOLD(H) 

8  CONTINUE 

9  CONTINUE 
* 

C       RETREIVE  THE  ARRAY  SHIFT  INFORMATION  FOR  PREVIOUS  SHIFTS 
* 

DO  7  1=1,7 

IF(SENSR(I) .EQ.-l)  GOTO  7 
DO  6  H  =  1,6 

SHIFT(I,H)  =  RSHIFT(SENSR(I) ,H) 
IF(I.EQ.l)  J(H)  =  RJ(S,H) 

6  CONTINUE 

7  CONTINUE 

K  =  1 

DO  10  I  =  1,18 
DO  11  H  =  1,4 

TIME(I,H)  =  RTIME(SENSR(LINKS(I) ) , J(K) ,H) 
11        CONTINUE 

IF(MOD(I,3) .EQ.0)K  =  K+l 
10     CONTINUE 

NR  =  RNR(S) 

DO  13  I  =  1,6 

DO  14  H  =  1,3 

ORIGIN(I,H)  =  RORIGIN(J(I) ,H) 
14        CONTINUE 
13     CONTINUE 
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RETREIVE  THE  WORKING  ARRAYS  FROM  THE  RANGE  ARRAYS 


DO 


20 


K  =  1 

20  I  = 

THS(I) 

THL(I) 

PHS ( I ) 

PHL(I) 

HS(I) 

HL(I) 

XS(I,1) 

XS(I,2) 

XS(I,3) 

IF (MOD 

CONTINUE 


1,18 


(I, 


RDATA(SENSR(LINKS(I) ) , J(K) ,1) 
RDATA(SENSR(LINKS(I) ) , J(K) ,2) 
RDATA(SENSR(LINKS(I) ) , J(K) ,3) 
RDATA ( SENSR ( LINKS ( I )  )  ,  J (K)  ,  4 ) 
RDATA(SENSR(LINKS(I) ) , J(K) ,5) 
RDATA ( SENSR ( LINKS (I)),J(K),6) 
RXS( SENSR (LINKS(I) ) , J(K)  ,1) 
RXS ( SENSR (LINKS(I) ) , J(K) ,2) 
RXS( SENSR (LINKS(I) ) , J(K) ,3) 
3) .EQ.O)  K  =  K+l 
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DO  21  I  = 
THER(I) 
PHER(I) 
HER(I) 
XER(I) 
YER(I) 
ZER(I) 
XL ( I , 1 ) 
XL (I, 2) 
XL (I, 3) 

CONTINUE 


1,6 

=  RERRTAB(S, J(I)  ,  1) 
=  RERRTAB ( S , J ( I ) , 2 ) 
=  RERRTAB ( S , J ( I )  ,  3 ) 
=  RERRTAB (S, J(I)  ,4) 
=  RERRTAB ( S , J ( I )  ,  5 ) 
=  RERRTAB (S, J( I)  ,6) 

=  RXL ( J ( I ) , 1 ) 

=  RXL ( J ( I ) , 2 ) 

=  RXL(J(I)  ,3) 
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WRITE(92,220) 
WRITE(92,221) 
WRITE(92,222 ) 
WRITE(92,223) 
WRITE(92,224) 
WRITE(92,225) 
WRITE(92,226) 
WRITE(92,227) 
WRITE(92,228) 

DO  7  7  K  =  1,NR 

WRITE(92, * ) 
WRITE(92, 230) 
N  =  (3*K)-2 
WRITE(92,231 
WRITE(92,232 
WRITE(92,233 
WRITE(92,234 
WRITE(92,235 
WRITE(92,236 
WRITE(92,237 
WRITE (92, 238 
WRITE(92,239 
WRITE(92,240 
CONTINUE 


(SENSR(N) ,N=1,7) 

(ERROR (N, 1) , N=l,7) 
( ERROR (N, 2) ,N=1,7) 
(ERROR(N,3) ,N=1,7) 
( ERROR (N, 4) ,N=1,7) 
(ERROR(N, 5) ,N=1, 7) 
(ERROR(N,6) ,N=1,7) 


J(K) 

(SENSR(LINKS(MP) ) ,MP=N,N+2) 

XS(N, 1) ,XS(N+1, 1) ,XS(N+2, 1) ,XL(K,1) , ORIGIN (K,l) 

XS(N,2 ) ,XS(N+1,2) ,XS(N+2,2) ,XL(K,2) , ORIGIN (K, 2) 

XS(N, 3) ,XS(N+1, 3) ,XS(N+2,3) ,XL(K,3) , ORIGIN (K, 3) 

THS(N) ,THS(N+1) ,THS(N+2) 

THL(N) ,THL(N+1) ,THL(N+2) 

PHS(N) , PHS(N+1) ,PHS(N+2) 

PHL(N) , PHL(N+1) ,PHL(N+2) 

HS(N) ,HS(N+1) ,HS(N+2) 

HL(N) ,HL(N+1) ,HL(N+2) 


WRITE (92, *) 
WRITE (92, *) 
WRITE(92,250) 
WRITE(92,251) 


(J(MP) ,MP=1,NR) 
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WRITE (92,*) 

WRITE(92,252)  (  (THL( 3*MP-2 ) -THS ( 3*MP-2 ) ) ,MP=1,NR) 

WRITE(92,*) 

WRITE(92,253)  ( (PHL ( 3*MP-2 ) -PHS ( 3*MP-2 ) ) ,MP=1,NR) 

WRITE(92,*) 

WRITE(92,254)  ( (HL( 3*MP-2 ) -HS ( 3*MP-2 ) ) ,MP=1,NR) 

WRITE (92,*) 

WRITE (92, 2 55)  ( (XL (MP, 1 ) -XS ( (3*MP)-2,1) ) ,MP=1,NR) 

WRITE(92,*) 

WRITE (92, 256)  ( (XL (MP, 2 ) -XS ( (3*MP)-2,2) ) ,MP=1,NR) 

WRITE (92,*) 

WRITE (92, 2 57)  ( (XL (MP, 3 ) -XS ( (3*MP)-2,3) ) ,MP=1,NR) 

DO  19  1=1,6 

HOLD(I)  =  SHIFT(1,I) 
19  CONTINUE 

ERROR  CORRECTIONS 

IF (.NOT.  CHECKO)  THEN 

CALL  ERRFIX(TIME, J, LINKS, SENSR,DVP, EXT, NR, ORIGIN, XS, XL, THS, THL, 
&  PHS, PHL, HS,HL, SHIFT, ERROR) 

ENDIF 

CALL  EVAL ( RDATA , RERRTAB , SENSR , LINKS , RNR , RJ , PHS , PHL , HL , HS , 
&  XS,XL,W1) 

IF (CHECKO)  THEN 

PRINT* , ' PRE-ANNEAL  MARK ' , S , MARK ( S ) 

WMIN  =  0.0D0 

DO  22  I  =  2,7 

IF(SENSR(I) .EQ.-l  .AND.  RNR(I).NE.6)  GOTO  22 
IF(ROBJ(SENSR(I ) ) .GT.WMIN)  WMIN  =  ROBJ ( SENSR ( I ) ) 

22  CONTINUE 

WMIN  =  WMIN/2.0 

PRINT* , ' TO  ANNEAL ' , S , ' WMIN ' , WMIN 

CALL  ANNEAL ( TIME , J , LINKS , SENSR , DVP , EXT , NR , ORIGIN , XS , XL , THS , THL , 
&  PHS, PHL, HS,HL, SHIFT, ERROR, WMIN) 

MKANN  =  .TRUE. 
MA  =  S 

23  ENDIF 


OUTPUT  THE  NEW  (CORRECTED)  POSLOC  DATA 
DO  78  K  =  1,NR 
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WRITE (92 
WRITE (92 
N  =  (3*K 
WRITE (92 
WRITE(92 
WRITE (92 
WRITE(92 
WRITE(92 
WRITE(92 
WRITE(92 
WRITE (92 
WRITE (92 
WRITE(92 
CONTINUE 


,230) 

)"2 

,231 

,232 

,233 

,234 

,235 

,236 

,237 

,238 

,239 

,240 


J(K) 

(SENSR(LINKS(MP) ) ,MP=N,N+2) 

XS(N,1) ,XS(N+1,1) ,XS(N+2,1) ,XL(K,1) , ORIGIN (K,l) 

XS(N,2) ,XS(N+l,2),XS(N+2,2) ,XL(K,2) , ORIGIN (K, 2) 

XS(N,3) ,XS(N+1,3) ,XS(N+2,3) ,XL(K,3) , ORIGIN (K, 3) 

THS(N) ,THS(N+1) ,THS(N+2) 

THL(N) ,THL(N+1) ,THL(N+2) 

PHS(N) ,PHS(N+1) ,PHS(N+2) 

PHL(N) ,PHL(N+1) ,PHL(N+2) 

HS(N) ,HS(N+1) ,HS(N+2) 

HL(N) ,HL(N+1) ,HL(N+2) 
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WRITE (92,*) 

WRITE(92,*) 

WRITE(92,250) 

WRITE(92,251)  ( J (MP) ,MP=1 , NR) 

WRITE(92,*) 

WRITE (92, 2 52)  ( (THL( 3*MP-2 ) -THS ( 3*MP-2 ) ) ,MP=1,NR) 

WRITE(92,*) 

WRITE(92,253)  ( (PHL ( 3*MP-2 ) -PHS ( 3*MP-2 ) ) ,MP=1,NR) 

WRITE (92,*) 

WRITE(92,254)  ( (HL ( 3*MP-2 ) -HS ( 3*MP-2 ) ) ,MP=1,NR) 

WRITE(92,*) 

WRITE (92, 2 55)  ( (XL (MP, 1 ) -XS ( (3*MP)-2,1) ) ,MP=1,NR) 

WRITE(92,*) 

WRITE (92, 2 56)  ( (XL (MP, 2 ) -XS ( ( 3*MP) -2 , 2 ) ) ,MP=1 , NR) 

WRITE (92,*) 

WRITE (92, 2 57)  ( ( XL (MP, 3 ) -XS ( (3*MP)-2,3) ) ,MP=1,NR) 


34 
33 


DO  33  I  =1,7 

IF(SENSR(I) .EQ.-l)  GOTO  33 
DO  34  H  =1,6 

RSHIFT(SENSR(I) ,H)  =  SHIFT(I,H) 

CONTINUE 
CONTINUE 


K  =  1 

DO  60  I  =  1,18 

RDATA ( SENSR (LINKS ( I ) 
RDATA ( SENSR ( LINKS ( I ) 
RDATA ( SENSR ( LINKS ( I ) 
RDATA ( SENSR (LINKS ( I ) 
RDATA ( SENSR (LINKS ( I ) 
RDATA ( SENSR (LINKS ( I ) 
RXS ( SENSR (LINKS ( I ) ) , J 
RXS(SENSR(LINKS(I) ) , J 
RXS(SENSR(LINKS(I) ) , J 
RERRTAB ( SENSR (LINKS ( I 
RERRTAB ( SENSR ( LINKS ( I 
RERRTAB ( SENSR (LINKS ( I 


,J(K) 

,J(K) 

,J(K) 

,J(K) 

,J(K) 

,J(K) 

(K),l) 

(K),2) 

(K),3) 

)),J(K) 

)),J(K) 

>),J(K) 


)  = 

)  = 

)  = 

)  = 


)  = 


,1) 
,2) 
,3) 


THS (I) 

THL(I) 

PHS(I) 

PHL(I) 
HS(I) 
HL(I) 
XS(I,1) 
XS(I,2) 
XS(I,3) 

=  THL(I) 

=  PHL(I) 

=   HL ( I ) 
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RERRTAB(SENSR(LINKS(I) ) , J(K) ,4)  =   XL(K,1) 
RERRTAB(SENSR(LINKS(I) ) , J(K) ,5)  =   XL(K,2) 
RERRTAB(SENSR(LINKS(I) ) , J(K) ,6)  =   XL(K,3) 
IF(MOD(I,3) .EQ.O)  K  =  K+l 
CONTINUE 


THS(I) 

PHS(I) 

HS(I) 

-  XS(I,1) 

-  XS(I,2) 

-  XS(I,3) 
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DO  61  K  =  1,6 
RXL(J(K) , 1) 
RXL ( J ( K ) , 2 ) 
RXL ( J ( K ) , 3 ) 

CONTINUE 


=  XL(K,1) 
=  XL(K,2) 
=   XL(K,3) 


MARK(S)  =   MARK(S)  +  1 
DO  41  K  =  1,7 

IF(SENSR(K) .EQ.-l)  GOTO  41 
SS  =  SENSR(K) 
W  =  0.0D0 
DO  42  I=1,RNR(SS) 
W  =  W  +  DSQRT( 


42 


CONTINUE 


( RERRTAB (SS,RJ(SS, I) ,6) )**2  + 
( RERRTAB (SS,RJ(SS, I) ,3) )**2  + 
( RDATA ( SS , RJ ( SS , I ) , 5 ) *RERRTAB ( SS , RJ ( SS , I ) , 2 ) ) 


*2) 
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ROBJ(SS)  =  W/REAL(RNR(SS) ) 
PRINT* , ' OBJ ' , SS , ROBJ ( SS ) 
CONTINUE 
PRINT*, 'MARK  ',S,MARK(S) 


IF(MARK(S) .LT.10)  GOTO  999 


220 
221 
222 
223 
224 
225 
226 
227 
228 
230 
231 
232 
233 
234 
235 
236 
237 
238 
239 
240 
250 
251 
252 
253 
254 
255 
256 
257 


STOP 

FORMAT 
FORMAT 
FORMAT 
FORMAT 
FORMAT 
FORMAT 
FORMAT 
FORMAT 
FORMAT 
FORMAT 
FORMAT 
FORMAT 
FORMAT 
FORMAT 
FORMAT 
FORMAT 
FORMAT 
FORMAT 
FORMAT 
FORMAT 
FORMAT 
FORMAT 
FORMAT 
FORMAT 
FORMAT 
FORMAT 
FORMAT 
FORMAT 

END 


11X, 'CENTER' ,20X, 
IX, 'ARRAYS' ,6X,I2 
/,1X, 'SHIFTS' ) 
3X, 'DELX' ,4X,F8.4 
3X, 'DELY' ,4X,F8.4 
3X, 'DELZ' ,4X,F8.4 
3X, 'DXTILT' ,2X,F8 
3X, 'DYTILT' ,2X,F8 
3X, 'DZROT' ,3X,F8. 
25X, 'REGION  ' ,12 
2X,3(3X, 'ARRAY' ,1 
IX, 'X' ,4X,F9.2,2( 
IX, 'Y' ,4X,F9.2,2( 
IX, ' Z' ,4X,F9.2,2( 
IX, 'THS' ,3X,F8.5, 
IX, 'THL' ,3X,F8.5, 
IX, 'PHS' ,3X,F8.5, 
IX,  'PHL' ,3X,F8.5, 
IX, 'HS' ,4X,F8.2,2 
IX, 'HL' ,4X,F8.2,2 
15X, 'CENTER  ARRAY 
IX, 'REGION' ,5X,I2 
IX, 'THER' ,2X,6(2X 
IX, 'PHER' ,2X,6(2X 
IX, "HER* ,3X,6(2X, 
IX, 'XER' ,2X,6(2X, 
IX, 'YER' ,2X,6(2X, 
IX, ' ZER' ,2X,6(2X, 


•ADJACENTS' ) 
,9X,I2,5(6X,I2) ) 

,2X,6(1X,F8.4) ) 
,2X,6(1X,F8.4) ) 
,2X,6(1X,F8.4) ) 
.4,2X,6(1X,F8.4) ) 
.4,2X,6(1X,F8.4) ) 
4,2X,6(1X,F8.4) ) 

) 

SBL  ' ) ,3X, 'LONGBASE' ,6X, 'GOAL' ) 
5X,F9.2,3X,F9.2) 
2,3X,F9.2) 
2,3X,F9.2) 
5) ,5X,F8.4,3X,F8.4) 
2(8X,F8.5) ,5X,F8.4,3X,F8.4) 
2(8X,F8.5) ,5X,F8.4,3X,F8.4) 
,5X,F8.4,3X,F8.4) 
5X,F8.2,3X,F8.2) 
5X,F8.2,3X,F8.2) 
) 


X,I2,1X, 
7X,F9.2) 
7X,F9.2) ,5X,F9, 
7X,F9.2) ,5X,F9 
2(8X,F8, 


2(8X,F8.5) 
(8X,F8.2), 
(8X,F8.2), 

ERROR  ANALYSIS 
,5(8X,I2)) 
,F8.5)) 
,F8.5)) 
F8.4) ) 
F8.3)) 
F8.3)) 
F8.3)) 
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APPENDIX  E:   COMPUTER  PROGRAMS  -  GENERAL  RANGE  AND  SYSTEM  SUPPORTING 

This  appendix  contains  the  following  FORTRAN  programs: 
UPDATE,  FIND,  PLANE,  RAYFIT  ( formally  RAYFIT1 ) ,  ISOGAD  (formally  ISGRAD1), 
ARRAY,  FINDOVR,  OVERLAP,  POINTST,  GLOBE,  RERROR. 


SUBROUTINE  UPDATE ( SENSR , DVP , EXT , SH I FT , ERROR , CPH , XPH , YPH , ZPH , 
&  PU,AU) 

*  THIS  SUBROUTINE  UPDATES  THE  POSITION  OF  THE  HYDROPHONES  FOR  THE 

*  CENTER  ARRAY  AND  ALL  OF  ITS  SATELLITE  ARRAYS.   POSITIONS  ARE 

*  PROVIDED  IN  GLOBAL  RANGE  COORDINATES. 

*  J. A.  GEMBARSKI 

*  NPS    01/10/92 

* 

*  INPUTS: 

*  SENSR   :  7  ELEMENT  ARRAY  CONTAINING  CENTER  (1)  AND  SATELLITE 

*  (2-7)  SENSOR  NUMBERS 

*  EXT      :  EXTRAPOLATION  CONTROL  FOR  DVP  PROFILE   1-EXTRAPOLATE 

*  IF  NEEDED,  2-  DO  NOT  EXTRAPOLATE 

*  SHIFT   :  ARRAY  CONTAINING  SHIFTS  TO  BE  PREFORMED  ON  CENTER  AND 

*  SATELLITE  ARRAYS  (FIRST  ELEMENT)  IN  THE  X,Y,Z  (SECOND 

*  ELEMENT,  1-3)  AND  THE  XTILT, YTILT, ZROT  (4-6) 

*  ERROR   :  ARRAY  CONTAINING  ERRORS  INDUCED  ON  CENTER  AND 

*  SATELLITE  ARRAYS  (FIRST  ELEMENT)  IN  THE  X,Y,Z  (SECOND 

*  ELEMENT,  1-3)  AND  THE  XTILT, YTILT, ZROT  (4-6) 

*  OUTPUTS: 

*  CPH, XPH, YPH, ZPH  :  GLOBAL  POSITIONS  OF  THE  C,X,Y,Z  HYDROPHONES  FOR 

*  CENTER  AND  SATELLITE  SENSORS  (FIRST  ELEMENT  1-7) 

*  PU,AU   :  CURRENT  DATA  FOR  THE  CENTER  SENSOR  PU-POSITION,  AU- 

*  ANGULAR  ORIENTATION 

* 

DIMENSION  CPH(7, 3),SHIFT(7,6),X(3),A(3) ,ERROR(7, 6) , 
&  XPH (7, 3) ,YPH(7, 3) , ZPH (7, 3) , PU ( 3 ) , AU ( 3 ) , 

&  CP(3) ,XP(3) ,YP(3) ,ZP(3) ,SENSR(7) 

DOUBLE  PRECISION  CPH, XPH, YPH, ZPH, X, A, AU, PU, SHIFT, 
&  XP,YP,ZP,CP, ERROR 

INTEGER   SENSR, I, ERR, EXT, DVP 
CHARACTER* 15  NAME1 

* 

C  UPDATE  POSITIONS  OF  C  PHONES  FROM  PREVIOUS  SHIFTS 

* 

1  =  0 
5  IF(SENSR(I+1) .NE.0)THEN 
1  =  1  +  1 

CALL  ARRAY(SENSR(I) ,X(1),X(2),X(3),A(1),A(2),A(3) ,ERR) 

X(l)  =  X(l)  +  ERROR (1,1)  +  SHIFT (1,1) 

X(2)  =  X(2)  +  ERROR(I,2)  +  SHIFT(I,2) 

X(3)  =  X(3)  +  ERROR(I,3)  +  SHIFT(I,3) 

A(l)  =  A(l)  +  ERROR (I, 4)  +  SHIFT (I, 4) 

A(2)  =  A(2)  +  ERROR(I,5)  +  SHIFT(I,5) 
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A(3)  =  A(3)  +  ERROR(I,6)   +  SHIFT( I , 6 ) 
IF(I.EQ.l)  THEN 
DO  10  N  =1,3 

PU(N)  =  X(N) 
AU(N)  =  A(N) 
10       CONTINUE 
END  IF 

CALL  GLOBE(X,A,XP,YP,ZP,CP) 
DO  7  LP=1,3 

CPH(I,LP)  =  CP(LP) 
XPH(I,LP)  =  XP(LP) 
YPH(I,LP)  =  YP(LP) 
ZPH(I,LP)  =  ZP(LP) 
7     CONTINUE 

IF(I.LE.6)GOTO  5 
ENDIF 

IF (SHIFT (1,3) .GT.O  .AND.  EXT.NE.2)  THEN 
EXT  =  1 

CALL  VELPRO(0,NAME1,DVP,EXT,PU(3) ) 
ENDIF 

RETURN 
END 
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*  it********************************************************************* 

SUBROUTINE  FIND ( AR,K,MI , MA) 

*  FIND  THE  MINIMUM  AND  MAXIMUM  OF  THE  ARRAY  AR  OF  SIZE  K 

*  J. A.  GEMBARSKI 

*  NPS    01/01/92 
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END 
********** 


DIMENSION  AR(K) 

DOUBLE  PRECISION 

AR,MI 

,MA 

INTEGER  K,I 

MI  =  AR(1) 

MA  =  AR(1) 

DO  10  1=2, K 

IF(AR(I) . 

GT. 

MA) 

MA  = 

AR(I) 

IF(AR(I) . 

LT. 

MI) 

MI  = 

AR(I) 

CONTINUE 

RETURN 

************************************************************ 


SUBROUTINE  PLANE ( X , Y , CO , A, B, C, E ) 

*  THIS  SUBROUTINE  FINDS  THE  EQUATION  OF  A  PLANE, 

*  PASSING  THROUGH  THE  THREE  POINTS  X,Y,C0 

*  J. A.  GEMBARSKI 

*  NPS    01/01/92 

* 

DIMENSION  X(3) , Y(3) , CO ( 3 ) 
DOUBLE  PRECISION  X , Y , CO , A, B , C , E 


A  = 

X(2)  *  (Y(3)  - 

C0(3) 

& 

-  X(3)  *  (Y(2)  - 

CO  (2) 

£ 

+  (Y(2)  *  C0(3) 

-  Y(3) 

B  =  -  X(l) 
&  +  X(3) 
&     -  (Y(l) 

C  =  X(l) 
&  -  X(2) 
&     +  (Y(l) 


(Y(3)  -  C0(3) 

(Y(l)  -  C0(1) 

C0(3)  -  Y(3) 

(Y(2)  -  C0(2) 

(Y(l)  -  C0(1) 

C0(2)  -  Y(2) 


CO (2)) 


C0(1)) 


C0(1)) 


E  =  -  X(l)  *  (Y(2) 

*  CO (3) 

-  Y(3) 

*  CO (2) ) 

&     +  X(2)  *  (Y(l) 

*  CO (3) 

-  Y(3) 

*  C0(1)) 

&     -  X(3)  *  (Y(l) 

*  C0(2) 

-  Y(2) 

*  C0(1)) 

RETURN 

END 
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*********************************************************************** 
SUBROUTINE  RAYFIT1 ( Al , A2 , PI , P2 , M, VEL , LM , DZ , VO , VI , TO , THO , 
+  TH1,IEST) 

C  09/12/89 

C    NEW  SUBROUTINE  TO  REPLACE  TGEN,  RAYTRACING  ALGORITHM. 

C 

C    NO  CHANGES  HAVE  BEEN  MADE  TO  THIS  SUBROUTINE.   RECIEVED  FROM 

C    LIB12.FOR  OF  REF  1 

C  J. A.  GEMBARSKI 

C  NPS    01/01/92 

Q      ********************************************************************* 

C        INPUTS: 

C  A1,A2  -  POSITION  OF  SENSOR  (A2  >  0  DOWN) 

C  P1,P2  -  POSITION  OF  SOUND  SOURCE  (  P2  >  0  DOWN  ) 

C  LM  -  ARRAY  CONTAINING  LAYER  MIDPOINTS 

C  M  -  NUMBER  OF  LAYER  MIDPOINTS 

C  VEL  -  ARRAY  CONTAINING  SOUND  VELOCITY  AT  THE 

C  LAYER  MIDPOINTS. 

C  VO  -  SPEED  INTERCEPT  VALUES 

C  VI  -  SPEED  SLOPE  VALUES 

C  DZ  -  DEPTH  INCREMENTS 

C  IEST  -  FLAG  FOR  INITIALIZING  THE  ANGLE 

C        OUTPUTS: 

C  TO  -  TRANSIT  TIME 

C  THO  -  ELEVATION  ANGLE  AT  THE  SENSOR 

C  TH1  -  ELEVATION  ANGLE  AT  THE  SOUND  SOURCE 

Q      *************************************************************** 

DOUBLE  PRECISION  VEL ( 300 ) , DZ ( 300 ) , LM ( 300 ) , VO ( 300 ) 
DOUBLE  PRECISION  VI ( 300 ) , ANG ( 300 ) 
DOUBLE  PRECISION  Al , A2 , PI , P2 , TO, THO, TH1 , EP, S , C 
DOUBLE  PRECISION  H, HO , DW, VA2 , VP2 , R, Z , RV, Ql , Q2 
INTEGER  M, IS, I, IEST, J, N 

EP  =  1D-6 

C    DETERMINE  LAYERS  INVOLVED  IN  RAY  FITTING 
N  =  M 
J  =  M 
DO  30  1=1, M  -  1 

IF  ( (LM(I) .LE.A2) .AND. (LM(I+1) .GT.A2) )  N=I 
IF  ( (LM(I) .LE.P2) .AND. (LM(I+1) .GT.P2) )  J=I 
30  CONTINUE 

C    MAKE  END  CORRECTIONS  FOR  THE  LAYERS 
DZ(N)  =  A2  -  LM(N) 
DZ(J)  =  LM(J+1)  -  P2 

C        COMPUTE  SPEED  OF  SOUND  AT  A2  AND  P2 
VA2  =  V0(N)  +  V1(N)*A2 
VP2  =  V0(J)  +  V1(J)*P2 
IF(IEST.NE.O)  GOTO  50 

C    INITIALIZE  THE  ELEVATION  ANGLE  AT  THE  SENSOR,  THO,  BY 
C    FITTING  A  STRAIGHT  LINE  SPEED  PROFILE  BETWEEN  P2  AND  A2 . 
IF(VEL(N) .EQ.VEL(J) )  THEN 

THO  =  DATAN( ( A2-P2 ) / (Pl-Al ) ) 
ELSE 

Q2  =  (VEL(N)*LM(J)  -  VEL ( J) *LM(N) )  /  ( VEL (N) -VEL ( J) ) 
Ql  =  0.5*(P1+A1)+(0.5*(P2-A2)*(P2+A2-2*Q2) )/(Pl-Al) 
THO  =  DATAN( (Ql-Al ) / (Q2-A2 ) ) 
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END  IF 

C    OUTER  LOOP:  SET  UP  RAY  FITTING  FOR  THO  =  ELEVATION  ANGLE 
50  S  =  DSIN(THO) 

C  =  DSQRT(1.0  -  S**2) 

I  =  N 

RV  =  C/VA2 

HO  =  Al 

Z  =  A2 

60  IF(V1(I) .EQ.0.0)  THEN 
DW  =  DZ(I)/S 
H  =  HO  +  DW*C 
ELSE 

Q2  =  -V0(I)/V1(I) 
IF  (Q2)  61,62,63 

61  IS  =  -1 
GOTO  64 

62  IS  =  0 
GOTO  64 

63  IS  =  1 

64  CONTINUE 

Ql  =  HO  +  (Q2-Z)*S/C 
R  =  DSQRT( (Q2-Z)**2  +  (Ql-H0)**2) 
C  =  RV*VEL(I) 
S  =  DSQRT(1.0-C**2) 
H  =  Ql  -  IS*R*S 
ENDIF 

IF  (I.EQ.J)  GOTO  80 
HO  =  H 
Z  =  LM(I) 
1  =  1-1 
GOTO  60 

80  TH1  =  DACOS(RV*VP2 ) 

C    FRACTIONAL  LAYER  CORRECTION 

IF(V1( J) .NE.0.0)  H  =  Ql  -  IS*R*DSIN(TH1) 
IF  (ABS(H-Pl) .LT.EP)  GOTO  90 

C    RE-ESTIMATE  THO 

THO  =  DATAN(DTAN(TH0)*H/P1) 
GOTO  50 

C    PREPARE  FOR  COMPUTATION  OF  TRANSIT  TIME. 
C    COLLECT  EXIT  AND  ENTRANCE  ANGLES. 
90  ANG(J)  =  TH1 
ANG(N+1)  =  THO 
C      G(J)  =  1/V1(J) 
C      G(N+1)  =  -1.0/V1(N) 
DO  95  I  =  J+1,N 

ANG(I)  =  DACOS(RV*VEL(I) ) 
C         G(I)  =  (1/V1(I))  -  (1/V1(I-1)) 
95  CONTINUE 

C    COMPUTE  TRANSIT  TIME 
TO  =  0.0D0 
DO  100  I  =  J,N 

IF(V1(I) .EQ.0.0)  THEN 

TO  =  TO  +  DZ(I)/(VO(I)*DSIN(ANG(I) ) ) 
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ELSE 

TO=TO  +  DLOG( (DCOS(ANG(I+l) ) * ( 1 . 0+DSIN( ANG ( I ) ) ) )/ 
*  ( (1.0+DSIN(ANG(I+1) ) )*DCOS(ANG(I) ) ) ) /Vl ( I ) 

ENDIF 
100  CONTINUE 

REMOVE  THE  END  CORRECTIONS. 
DZ(J)  =  LM(J+1)  -  LM(J) 
DZ(N)  =  LM(N+1)  -  LM(N) 
IEST  =  1 

RETURN 
END 
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****************************************************************** 
SUBROUTINE  ISOGAD1 ( Al , A2 , TO , THO , N , LM, VEL , VO , VI , DZ , H , Z , TH1 ) 


NO  CHANGES  HAVE  BEEN  MADE  TO  THIS  SUBROUTINE.   RECIEVED  FROM 

LIB12.FOR  OF  REF  1  (ORIGINAL  NAME:  ISOGRAD1) 

J. A.  GEMBARSKI 
NPS    01/01/92 

09/25/89 
TO  :     TRANSIT  TIME  (SEC). 
THO  :  ELEVATION  ANGLE  AT  SENSOR  (RAD). 
Al  :   HORIZONTAL  COORDINATE  OF  SENSOR. 
A2  :   VERTICAL  COORDINATE  OF  SENSOR,  POSITIVE  DOWN. 
V0,V1  :  ARRAYS  CONTAINING  SOUND  VELOCITY  PARAMETERS. 
LM  :   ARRAY  CONTAINING  LAYER  MIDPOINTS. 
N  :    INDEX  OF  DEEPEST  LAYER  USED. 


DIMENSION  LM(300) ,V0(300) , VI (300) ,DZ(300) , VEL (300) 
DOUBLE  PRECISION  TO, H, HO, Z , Al , A2 , THO, TH1 , VEL 
DOUBLE  PRECISION  LM, V0 , VI , DZ , Ql , Q2 
DOUBLE  PRECISION  VA2 , R, TH , RV, DW, DT, X , T 
INTEGER  N, IS, I 

I  =  N 

T  =  0.0D0 

TH=TH0 

HO  =  Al 

VA2=V0(I)+V1(I)*A2 

RV=DCOS(TH)/VA2 

Z  =  A2 

DZ(N)  =  Z  -  LM(N) 

50  IF(V1(I) .EQ.0.0)  THEN 

DW  =  DZ(I ) /DSIN(TH) 
DT  =  DW/V0(I) 
H  =  HO  +  DW*DCOS(TH) 
TH1  =  TH 
ELSE 

Q2=-V0(I)/V1(I) 
IF  (Q2)  51,52,53 

51  IS  =  -1 
GOTO  54 

52  IS  =  0 
GOTO  54 

53  IS  =  1 

54  CONTINUE 

Q1=H0  +  (Q2-Z)*DTAN(TH) 

R=DSQRT( (Q2-Z)**2  +  (Ql-H0)**2) 

THl=DACOS(RV*VEL(I) ) 

DT=DLOG( (DCOS(TH)/(1.0+DSIN(TH) ) )* ( ( 1 . 0+DSIN (TH1 ) )/ 
*       DCOS(THl) ) )/Vl(I) 

H=Q1  -  IS*R*DSIN(TH1) 
ENDIF 
T=T+DT 

IF  (T.GE.T0)  GOTO  60 
Z=LM(I) 
HO  =  H 
TH=TH1 
1  =  1-1 
GOTO  50 
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60   DT=T0+DT-T 

IF(V1(I) .EQ.0.0)  THEN 

DW  =  V0(I)*DT 

DZ(I)  =  DW*DSIN(TH1) 

H  =  HO  +  DW*DC0S(TH1) 

Z  =  Z  -  DZ(I) 
ELSE 

X=(EXP(DT*V1(I) ) )*(1+DSIN(TH) )/DCOS(TH) 

TH1=DAC0S( (2*X)/(1+X**2) ) 

H  =  Ql  -  IS*R*DSIN(TH1) 

Z  =  Q2  -  IS*R*DCOS(THl) 
ENDIF 

RESTORE  THE  END  LAYERS. 

DZ(I)  =  LM(I+1)  -  LM(I) 
DZ(N)  =  LM(N+1)  -  LM(N) 

RETURN 
END 
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********************************************************************** 

SUBROUTINE  ARRAY ( AR, Al , A2 , A3 , XTILT , YTILT , ZROT , ERR ) 

C  THIS  SUBROUTINE  PROVIDES  RANGE  COORDINATES  OF  THE  ACOUSTIC 

C  CENTERS  OF  THE  NANOOSE  ARRAYS 

C  J. A.  GEMBARSKI 

C  NPS    01/01/92 

c 

REAL*8  A1,A2, A3, XTILT, YTILT, ZROT 
INTEGER*4  AR,ERR 

C   ARRAY  0 

IF(AR.EQ.O)  THEN 
Al  =  12188. 01D0 
A2  =  -131.52D0 
A3  =  1295. 33D0 
XTILT  =   0.002909 
YTILT  =   0.014835 
ZROT   =  -0.208183 

C   ARRAY  1 

ELSEIF(AR.EQ. 1)  THEN 

Al  =  19463. 16D0 

A2  =  -174.99D0 

A3  =  1308. 76D0 

XTILT  =   0.061523 

YTILT  =  -0.036070 

ZROT  =  1.362579 
C   ARRAY  2 

ELSEIF(AR.EQ.2)  THEN 

Al  =  26991. 39D0 

A2  =  -109.83D0 

A3  =  1323. 35D0 

XTILT  =   0.000145 

YTILT  =   0.005236 

ZROT  =  2.670336 
C   ARRAY  3 

ELSEIF(AR.EQ.3)  THEN 

Al  =  34505. 10D0 

A2  =  -80.76D0 

A3  =  1323. 32DO 

XTILT  =   0.027925 

YTILT  =  -0.011345 

ZROT  =  2.928139 
C   ARRAY  4 

ELSEIF(AR.EQ.4)  THEN 

Al  =  42005. 19D0 

A2  =  -55.17D0 

A3  =  1318. 28D0 

XTILT  =   0.001164 

YTILT  =  -0.040288 

ZROT  =  -2.315877 
C   ARRAY  5 

ELSEIF(AR.EQ.5)  THEN 

Al  =  49497. 00D0 

A2  =  -25.23D0 

A3  =  1315. 58D0 

XTILT  =  -0.000291 

YTILT  =  -0.004027 

ZROT  =  1.668535 
C   ARRAY  6 
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ELSEIF(AR.EQ.6)  THEN 
Al  =  56972. 28D0 
A2  =  -21.21D0 
A3  =  1308. 50D0 
XTILT  =   0.013817 
YTILT  =   0.041161 
ZROT   =  -0.703420 

ARRAY  7 

ELSEIF(AR.EQ.7)  THEN 
Al  =  64680. 66D0 
A2  =   15.33D0 
A3  =  1353. 39D0 
XTILT  =   0.034907 
YTILT  =   0.022835 
ZROT   =  -0.574144 

ARRAY  8 

ELSEIF(AR.EQ.8)  THEN 
Al  =  71969. 73D0 
A2  =  -29.28D0 
A3  =  1300. 89D0 
XTILT  =  -0.005963 
YTILT  =  -0.012217 
ZROT   =  -1.577341 

ARRAY  9 

ELSEIF(AR.EQ.9)  THEN 


Al  = 

3, 

.  00D0 

A2  = 

3, 

.  00D0 

A3  = 

1, 

.00D0 

XTILT 

=   0, 

.000000 

YTILT 

=   0 

.000000 

ZROT 

=   0. 

.000000 

ARRAY  10 

ELSEIF(AR.EQ. 10)  THEN 

Al  =  . 

47100 

.00D0 

A2  = 

-3600 

.00D0 

A3  = 

1300.1 

DODO 

XTILT 

=   0 

.000000 

YTILT 

=   0 

.000000 

ZROT 

=   0 

.000000 

ARRAY  11 

ELSEIF(AR.I 

3Q.11)  THEN 

Al  =  : 

23173 

•  89D0 

A2  = 

-6488 

.  40D0 

A3  = 

1312.1 

D9D0 

XTILT 

=  -0 

.004654 

YTILT 

=   0 

.000436 

ZROT 

=   2 

.784376 

ARRAY  12 

ELSEIF(AR.: 

EQ.12)  THEN 

Al  = 

30731 

.25D0 

A2  = 

-6553 

•  05D0 

A3  = 

1312. 

90D0 

XTILT 

=   0 

.002036 

YTILT 

=   0 

.001745 

ZROT 

=  -3 

.042179 

ARRAY  13 

ELSEIF(AR.: 

EQ.13)  THEN 

Al  = 

38213 

.  61D0 

A2  = 

-6640 

.77D0 

A3  = 

1323. 

05D0 

XTILT 

=   0 

.000291 
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YTILT  =   0.006254 
ZROT   =   1.373522 

ARRAY  14 

ELSEIF(AR.EQ.14)  THEN 
Al  =  45647. 07D0 
A2  =  -6513. 18D0 
A3  =  1324. 78D0 
XTILT  =   0.001309 
YTILT  =   0.002327 
ZROT   =  -2.348044 

ARRAY  15 

ELSEIF(AR.EQ.15)  THEN 
Al  =  53249. 43D0 
A2  =  -6354. 60D0 
A3  =  1316. 66D0 
XTILT  =   0.003345 
YTILT  =   0.004509 
ZROT   =   0.581544 

ARRAY  16 

ELSEIF(AR.EQ. 16)  THEN 
Al  =  60859. 74D0 
A2  =  -6356. 07D0 
A3  =  1313. 42D0 
XTILT  =   0.014835 
YTILT  =   0.036943 
ZROT   =   2.303276 

ARRAY  17 

ELSEIF(AR.EQ. 17)  THEN 
Al  =  68217. 93D0 
A2  =  -6524. 10D0 
A3  =  1313. 43D0 
XTILT  =   0.008290 
YTILT  =   0.034761 
ZROT   =   2.158449 

ARRAY  54 

ELSEIF(AR.EQ.54)  THEN 
Al  =  38029. 95D0 
A2  =   5401. 98D0 
A3  =  1212. 69D0 
XTILT  =   0.007709 
YTILT  =  -0.003782 
ZROT   =  -1.056919 

ARRAY  55 

ELSEIF(AR.EQ.55)  THEN 
Al  =  45645. 75D0 
A2  =  6369. 66D0 
A3  =  1188. 12D0 
XTILT  =   0.027634 
YTILT  =   0.039415 
ZROT   =  -0.728553 

ARRAY  56 

ELSEIF(AR.EQ.56)  THEN 
Al  =  53180. 13D0 
A2  =   6417. 96D0 
A3  =   1218. 84D0 
XTILT  =   0.037525 
YTILT  =   0.048142 
ZROT   =  -1.392651 

ARRAY  57 

ELSEIF(AR.EQ.57)  THEN 
Al  =  60745. 71D0 
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A2  =   6419. 40D0 
A3  =  1088. 24D0 
XTILT  =   0.006981 
YTILT  =   0.001891 
ZROT   =  -3.108606 

ARRAY  23 

ELSEIF(AR.EQ.23)  THEN 
Al  =  41605. 14D0 
A2  =-12150. 18D0 
A3  =  1268. 23D0 
XTILT  =  -0.002182 
YTILT  =   0.003200 
ZROT   =  -1.845214 

ARRAY  24 

ELSEIF(AR.EQ.24)  THEN 
Al  =  49572. O0DO 
A2  =-12966. 00D0 
A3  =  1300. 00D0 
XTILT  =  -0.007272 
YTILT  =   0.055269 
ZROT   =  -1.343904 

ARRAY  25 

ELSEIF(AR.EQ.25)  THEN 
Al  =  56993. 79D0 
A2  =-12999. 33D0 
A3  =  1205. 48D0 
XTILT  =   0.000291 
YTILT  =  -0.002182 
ZROT   =  -0.593726 

ARRAY  2  6 

ELSEIF(AR.EQ.26)  THEN 
Al  =  64442. 94D0 
A2  =-12971. 04D0 
A3  =  1255. 35D0 
XTILT  =  -0.014835 
YTILT  =  -0.012654 
ZROT   =   3.134192 

ARRAY  2  7 

ELSEIF(AR.EQ.27)  THEN 
Al  =  22119. 60D0 
A2  =-15908. 70D0 
A3  =   -83.00D0 
XTILT  =   0.000000 
YTILT  =   0.000000 
ZROT   =   0.000000 

ARRAY  28 

ELSEIF(AR.E0_.28)  THEN 
Al  =  45000. OODO 
A2  =   1500. OODO 
A3  =  1350. OODO 
XTILT  =   0.000000 
YTILT  =   0.000000 
ZROT   =   0.000000 

ARRAY  29 

ELSEIF(AR.EQ.29)  THEN 


Al  = 

0.00D0 

A2  = 

0.00D0 

A3  = 

0.00D0 

XTILT  = 

0.000000 

YTILT  = 

0.000000 

ZROT   = 

0.000000 
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ELSE 

Al  =  0. 

0D0 

A2  =  0. 

0D0 

A3  =  0. 

0D0 

XTILT  = 

0. 

000000 

YTILT  = 

0. 

000000 

ZROT   = 

0. 

000000 

ERR  =  1 

ENDIF 

RETURN 

END 
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*********************************************************************** 
SUBROUTINE  FINDOVR( I , REGION, ERR) 


SUBROUTINE  TO  FIND  ALL  CROSSOVER  REGIONS  FOR  THE  GIVEN  ARRAY 
ON  THE  NANOOSE  RANGE. 

J. A.  GEMBARSKI 
NPS    01/10/92 


DIMENSION  REGION(6) 
INTEGER*4  I , REGION, ERR, K 


DO  10  K  =1,6 

REGION (K)  =  0 

10  CONTINUE 

ERR   =  0 

* 

c 

ARRAY   1 

IF(I  .EQ.  1  )THEN 

REGION(l)  = 

1 

c 

ARRAY   2 

ELSEIF(I  .EQ. 

2  )THEN 

REGION(l)  = 

1 

REGION(2)  = 

2 

REGION(3)  = 

3 

c 

ARRAY   3 

ELSEIF(I  .EQ. 

3  )THEN 

REGION(l)  = 

3 

REGION(2)  = 

4 

REGION(3)  = 

5 

REGION(4)  = 

6 

c 

ARRAY   4 

ELSEIF(I  .EQ. 

4  )THEN 

REGION(l)  = 

5 

REGION(2)  = 

6 

REGION(3)  = 

7 

REGION(4)  = 

8 

REGION(5)  = 

9 

REGION(6)  = 

10 

c 

ARRAY   5 

ELSEIF(I  .EQ. 

5  )THEN 

REGION(l)  = 

8 

REGION(2)  = 

9 

REGION(3)  = 

14 

REGION(4)  = 

15 

REGION(5)  = 

16 

REGION(6)  = 

17 

c 

ARRAY   6 

ELSEIF(I  .EQ. 

6  )THEN 

REGION(l)  = 

15 

REGION (2)  = 

16 

REGION(3)  = 

18 

REGION(4)  = 

19 

REGION(5)  = 

20 

REGION(6)  = 

21 

c 

ARRAY   7 

ELSEIF(I  .EQ. 

7  )THEN 

REGION(l)  = 

19 

REGION(2)  = 

20 

REGION(3)  = 

26 

REGION(4)  = 

27 

c 

ARRAY   8 
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ELSEIF(I 

•  EQ. 

8  )THEN 

REGION(l)  = 

27 

ARRAY   11 

ELSEIF(I 

.EQ. 

11) THEN 

REGION 

1)  = 

1 

REGION 

2)  ■ 

2 

ARRAY   12 

ELSEIF(I 

•  EQ. 

12) THEN 

REGION 

1)  = 

2 

REGION 

2)  = 

3 

REGION 

3)  = 

4 

ARRAY   13 

ELSEIF(I 

.EQ. 

13) THEN 

REGION 

1)  = 

4 

REGION 

2)  = 

5 

REGION 

3)  = 

10 

REGION 

4)  = 

11 

ARRAY   14 

ELSEIF(I 

.EQ. 

14)THEN 

REGION 

1)  = 

9 

REGION 

2)  = 

10 

REGION 

3)  = 

11 

REGION 

4)  = 

12 

REGION 

5)  = 

13 

REGION 

6)  = 

14 

ARRAY   15 

ELSEIF(I 

.EQ. 

15)THEN 

REGION 

1)  = 

13 

REGION 

2)  = 

14 

REGION 

3)  = 

15 

REGION 

4)  = 

21 

REGION 

5)  = 

22 

REGION 

6)  = 

23 

ARRAY   16 

ELSEIF(I 

.EQ. 

16) THEN 

REGION 

1)  = 

20 

REGION 

2)  = 

21 

REGION 

3)  = 

22 

REGION 

4)  = 

24 

REGION 

5)  = 

25 

REGION 

6)  = 

26 

ARRAY   17 

ELSEIF(I 

.EQ. 

17) THEN 

REGION 

1)  = 

25 

REGION 

2)  = 

26 

REGION 

3)  = 

27 

ARRAY   2  3 

ELSEIF(I 

.EQ. 

23)THEN 

REGION 

,1)  = 

11 

REGION 

2)  = 

12 

ARRAY   2  4 

ELSEIF(I 

.EQ. 

24) THEN 

REGION 

[1)  = 

12 

REGION 

(2)  = 

13 

REGION 

3)  = 

23 

ARRAY   2  5 

ELSEIF(I 

.EQ. 

25) THEN 

REGION 

.1)  = 

22 

REGION 

2)  = 

23 

REGION 

3)  = 

24 

ARRAY   26 
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ELSEIF(I  .EQ.  26)THEN 
REGION(l)  =  24 
REGION(2)  =  25 
ARRAY   54 

ELSEIF(I  .EQ.  54)THEN 
REGION(l)  =  6 
REGION(2)  =  7 
ARRAY   55 

ELSEIF(I  .EQ.  55)THEN 
REGION(l)  =  7 
REGION(2)  =  8 
REGION(3)  =  17 
ARRAY   56 

ELSEIF(I  .EQ.  56)THEN 
REGION(l)  =  16 
REGION(2)  =  17 
REGION(3)  =  18 
ARRAY   57 

ELSEIF(I  .EQ.  57)THEN 
REGION(l)  =  18 
REGION(2)  =  19 
ELSE 

ERR  =  1 
ENDIF 
RETURN 
END 


113 


********************************************************************* 


SUBROUTINE  OVERLAP (J, AR, ERR) 

SUBROUTINE  TO  RETURN  THE  ARRAYS  ASSOCIATED  WITH  THE  INPUT 
CROSSOVER  REGION  J  FOR  THE  NANOOSE  RANGE. 

J. A.  GEMBARSKI 
NPS    01/01/92 


DIMENSION  AR(3) 
INTEGER*4   ERR,J,AR 


* 
C 


REGION  1 

IF(J  .EQ. 

1  )THEN 

AR(1)  = 

1 

AR(2)  = 

2 

AR(3)  = 

11 

REGION  2 

ELSEIF( J 

.EQ. 

2 

)THEN 

AR ( 1 )  = 

2 

AR ( 2 )  = 

11 

AR ( 3 )  = 

12 

REGION  3 

ELSEIF( J 

.EQ. 

3 

)THEN 

AR(1)  = 

2 

AR ( 2 )  = 

3 

AR ( 3 )  = 

12 

REGION  4 

ELSEIF( J 

.EQ. 

4 

)THEN 

AR ( 1 )  = 

3 

AR ( 2 )  = 

12 

AR ( 3 )  = 

13 

REGION  5 

ELSEIF( J 

.EQ. 

5 

)THEN 

AR ( 1 )  = 

3 

AR ( 2 )  = 

4 

AR ( 3 )  = 

13 

REGION  6 

ELSEIF( J 

.EQ. 

6 

)THEN 

AR ( 1 )  = 

3 

AR ( 2 )  = 

4 

AR(3)  = 

54 

REGION  7 

ELSEIF( J 

.EQ. 

7 

)THEN 

AR ( 1 )  = 

4 

AR(2)  = 

54 

AR ( 3  )  = 

55 

REGION  8 

ELSEIF( J 

.EQ. 

8 

)THEN 

AR ( 1 )  = 

4 

AR ( 2 )  = 

5 

AR ( 3 )  = 

55 

REGION  9 

ELSEIF(J 

.EQ. 

9 

)THEN 

AR(1)  = 

4 

AR(2)  = 

5 

AR ( 3 )  = 

14 

REGION  10 

ELSEIF(J 

.EQ. 

10) THEN 

AR ( 1 )  = 

4 

AR(2)  = 

13 

AR(3)  = 

14 
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REGION  11 

ELSEIF(J 

•  EQ. 

11) THEN 

AR(1)  = 

13 

AR(2)  = 

14 

AR(3)  = 

23 

REGION  12 

ELSEIF(J 

.EQ. 

12) THEN 

AR(1)  = 

14 

AR(2)  = 

23 

AR(3)  = 

24 

REGION  13 

ELSEIF(J 

.EQ. 

13) THEN 

AR(1)  = 

14 

AR(2)  = 

15 

AR(3)  = 

24 

REGION  14 

ELSEIF(J 

.EQ. 

14) THEN 

AR(1)  = 

5 

AR(2)  = 

14 

AR(3)  = 

15 

REGION  15 

ELSEIF(J 

.EQ. 

15) THEN 

AR(1)  = 

5 

AR(2)  = 

6 

AR(3)  = 

15 

REGION  16 

ELSEIF(J 

.EQ. 

16) THEN 

AR(1)  = 

5 

AR(2)  = 

6 

AR(3)  = 

56 

REGION  17 

ELSEIF( J 

.EQ. 

17) THEN 

AR ( 1 )  = 

5 

AR ( 2 )  = 

55 

AR ( 3 )  = 

56 

REGION  18 

ELSEIF( J 

.EQ. 

18) THEN 

AR ( 1 )  = 

6 

AR(2)  = 

56 

AR(3)  = 

57 

REGION  19 

ELSEIF(J 

.EQ. 

19) THEN 

AR(1)  = 

6 

AR(2)  = 

7 

AR(3)  = 

57 

REGION  20 

ELSEIF(J 

.EQ. 

20)THEN 

AR(1)  = 

6 

AR ( 2 )  = 

7 

AR(3)  = 

16 

REGION  21 

ELSEIF(J 

.EQ. 

21) THEN 

AR(1)  = 

6 

AR(2)  = 

15 

AR(3)  = 

16 

REGION  22 

ELSEIF(J 

.EQ. 

22) THEN 

AR(1)  = 

15 

AR(2)  = 

16 

AR(3)  = 

25 

REGION  23 
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ELSEIF 

J  .EQ. 

23) THEN 

AR(1 

=  15 

AR(2 

=  24 

AR(3 

=  25 

REGION  2< 

I 

ELSEIF 

J  .EQ. 

24) THEN 

AR(1 

=  16 

AR(2 

=  25 

AR(3 

=  26 

REGION  21 

ELSEIF 

J  .EQ. 

25) THEN 

AR(1 

=  16 

AR(2 

=  17 

AR(3 

=  26 

REGION  2( 

ELSEIF 

[J  .EQ. 

26) THEN 

AR(1 

=  7 

AR(2 

=  16 

AR(3 

=  17 

REGION  2' 

1 

ELSEIF 

[J  .EQ. 

27) THEN 

AR(1 

=  7 

AR(2 

=  8 

AR(3 

=  17 

ELSE 

AR(1 

=  0 

AR(2 

1  =  o 

AR(3 

=  0 

ERR 

=  1 

ENDIF 

RETURN 

END 
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*********************************************************************** 

SUBROUTINE  POINTST ( J, XO, YO, ZO ) 

* 

*  SUBROUTINE  TO  FIND  THE  INITIAL  STARTING  POINT  (THE  CENTER  OF  A 

*  TRIPLE  OVERLAP  REGION)  XO  AND  YO,  FOR  OVERLAP  REGION  J. 

*  THE  INITIAL  STARTING  POINT  IS  AT  DEPTH  XO  (400  FT)  ARBITRARILY 

*  J. A.  GEMBARSKI 

*  NPS    01/01/92 


* . 


DIMENSION  X(3) ,Y(3) ,Z(3) ,AR(3) 

REAL*8      X,Y,Z,X0,Y0,Z0,NUM1,NUM2,DEN,A,B,C 
INTEGER*4   J,AR,ERR 
* 

CALL  OVERLAP ( J, AR, ERR) 

* 

DO  10  1=1,3 

CALL  ARRAY(AR(I) ,X(I),Y(I),Z(I) ,A,B,C,ERR) 
10  CONTINUE 
* 

C      SET  THE  DEPTH  OF  THE  STARTING  POINT 

* 

ZO  =  400.0 

* 

NUM1  =  (X(2)**2-X(1)**2+Y(2)**2-Y(1)**2)/(X(2)-X(1) ) 

NUM2  =  (X(3)**2-X(1)**2+Y(3)**2-Y(1)**2)/(X(3)-X(1) ) 

DEN   =  2*((Y(1)-Y(3))/(X(3)-X(1))-(Y(1)-Y(2))/(X(2)-X(1))) 
* 

YO  =  (NUM1  -  NUM2)/DEN 

XO  =  NUM1/2  +  Y0*(Y(1)-Y(2) )/(X(2)-X(l) ) 

* 

RETURN 
END 
************************************************************************ 

SUBROUTINE  GLOBE ( P , A, XP, YP , ZP,CP) 

* 

*  THIS  SUBROUTINE  DETERMINES  THE  GLOBAL  POSITIONS  OF  EACH  HYDROPHONE 

*  OF  THE  IMPUTED  ARRAY.   INPUT  POSITION  IS  THAT  OF  THE  ACOUSTIC 

*  CENTER. 

* 

*  INPUTS 

*  P:  POSITION  ARRAY  P(l)  P(2)  P(3),  X,Y,Z  POSITIONS  RESPECTIVELY 

*  A:  ORIENTATION  ARRAY  A ( 1 ) , A ( 2 ) , A ( 3 )  XTILT, YTILT, ZROT  RESPECT. 
* 

*  OUTPUTS 

*  XP:  POSITION  OF  THE  X  HYDROPHONE  OF  THE  SENSOR   X,Y,Z  COORDINATES 

*  RESPECTIVELY 

*  YP,ZP,CP:  THE  Y,  Z,  AND  C  HYDROPHONE  POSITIONS 

*  J. A.  GEMBARSKI 

*  NPS    01/01/92 

* 

DIMENSION  B(5,3),XP(3),YP(3),ZP(3),CP(3),P(3),A(3) 
INTEGER  I 

DOUBLE  PRECISION  P, A, B, SI , S2 , S3 , CI , C2 , C3 , D, XP, YP, ZP, CP 

* 

D=30.0D0 

* 

*  FORM  THE  SINES  AND  COSINES  OF  ALL  EULER  ANGLES : ROLL, PITCH  AND  YAW 
* 


S2=DSIN(A(1) ) 
C2=DSQRT(1-S2**2) 
S1=DSIN(A(2) )/C2 
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C1=DSQRT(1-S1**2) 
S3=-DSIN(A(3) ) 
C3=DCOS(A(3) ) 


FORM  THE  B  TRANSITION  MATRIX 


66 


B(1,1)=C2*C3 

B(1,2)=C2*S3 

B(1,3)=S2 

B(2, 1)=-S1*S2*C3-C1*S3 

B(2,2)=-S1*S2*S3+C1*C3 

B(2,3)=S1*C2 

B(3, 1)=-C1*S2*C3+S1*S3 

B(3,2)=-C1*S2*S3-S1*C3 

B(3,3)=C1*C2 

DO  66  1=1,3 

B(4,I)=0.0D0 

B(5,I)=  0.5*(B(I,1)  + 

B(I,2) 

+ 

CONTINUE 

PRINT*, "Bl' ,B(1,1) ,B(1, 

2) ,B(1 

3) 

PRINT*, •B2',B(2,1),B(2, 

2) ,B(2 

3) 

PRINT*, 'B3' ,B(3,1) ,B(3, 

2),B(3 

3) 

B(I,3)) 


LOCATE  THE  X,Y,Z,C  HYDROPHONE  LOCATIONS 


XP(1)=P(1) 
XP(2)=P(2) 
XP(3)=P(3) 


(D)*(B(1,1 
(D)*(B(1,2 
(D)*(B(5,3 


YP( 1)=P(1)  +  (D) * (B(2, 1 

YP(2)=P(2)  +  (D)*(B(2,2 

YP(3)=P(3)  +  (D)*(B(5,3 

ZP(1)=P(1)  +  (D)*(B(3,1 

ZP(2)=P(2)  +  (D)*(B(3,2 

ZP(3)=P(3)  +  (D)*(B(5,3 

CP(1)=P(1)  +  (D) * (B(4, 1 

CP(2)=P(2 )  +  (D) * (B(4,2 

CP(3)=P(3)  +  (D)*(B(5,3 


-B(5,l) 
-B(5,2) 
-B(l,3) 

-B(5,l) 
-B(5,2) 
-B(2,3) 

-B(5,l) 
-B(5,2) 
-B(3,3) 

-B(5,l) 
-B(5,2) 
-B(4,3) 


RETURN 
END 
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SUBROUTINE  RERROR(AR, ERRAR, ERR) 
THIS  SUBROUTINE  PROVIDES  RANGE  INDUCED  ERRORS  TO  SENSORS 
(DELX,DELY,DELZ,DXTILT,DYTILT,DZROT)  FOR  THE  NANOOSE  RANGE 
FOR  INPUT  INTO  THE  PROGRAM  SIMSTRT 

J. A.  GEMBARSKI 
NPS    01/01/92 


DIMENSION  ERRAR(6) 
DOUBLE  PRECISION  ERRAR, VAL 
INTEGER  AR,ERR,NO 
CHARACTER* 1  RES 
ARRAY  0 

IF(AR.EQ.O)  THEN 


ERRAR ( 1 ) 

= 

0.0D0 

ERRAR(2) 

= 

0.0D0 

ERRAR(3) 

= 

0.0D0 

ERRAR(4) 

= 

0.0D0 

ERRAR(5) 

= 

0.0D0 

ERRAR ( 6 ) 

= 

0.0D0 

c 

ARRAY  1 

ELSEIF(AR. 

EQ 

1)  THEN 

ERRAR(l) 

= 

0.0D0 

ERRAR ( 2 ] 

= 

0.0D0 

ERRAR(3] 

= 

0.0D0 

ERRAR ( 4 ) 

= 

0.0D0 

ERRAR ( 5 ) 

= 

0.0D0 

ERRAR ( 6 ) 

= 

0.0D0 

c 

ARRAY  2 

ELSEIF(AR. 

EQ 

.2)  THEN 

ERRAR ( 1 ) 

= 

0.0D0 

ERRAR ( 2 ) 

= 

0.0D0 

ERRAR ( 3 ; 

= 

0.0D0 

ERRAR ( 4 ) 

= 

0.0D0 

ERRAR ( 5 ) 

= 

0.0D0 

ERRAR ( 6 ) 

= 

0.0D0 

c 

ARRAY  3 

ELSEIF(AR. 

EQ 

.3)  THEN 

ERRAR(l) 

= 

0.0D0 

ERRAR(2) 

= 

0.0D0 

ERRAR ( 3 ) 

= 

0.0D0 

ERRAR ( 4 ; 

= 

0.0D0 

ERRAR ( 5 ) 

= 

0.0D0 

ERRAR(6] 

= 

0.0D0 

c 

ARRAY  4 

ELSEIF(AR. 

EQ 

.4)  THEN 

ERRAR(l) 

= 

0.0D0 

ERRAR ( 2 ; 

= 

0.0D0 

ERRAR(3] 

= 

0.0D0 

ERRAR(4) 

= 

0.0D0 

ERRAR ( 5 ; 

= 

0.0D0 

ERRAR ( 6 ; 

= 

0.0D0 

c 

ARRAY  5 

ELSEIF(AR. 

EQ 

. 5 )  THEN 

c 

ERRAR(l) 

= 

7.9D0 

c 

ERRAR(2; 

as. 

-6.2D0 

c 

ERRAR ( 3 ) 

as. 

-1.8D0 

c 

ERRAR(4) 

= 

0.007D0 

c 

ERRAR ( 5 ) 

=  ■ 

-0.003D0 

c 

ERRAR(6; 

= 

0.001D0 
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ERRAR(1 
ERRAR (2 
ERRAR (3 
ERRAR(4 
ERRAR(5 
ERRAR(6 
C   ARRAY  6 

ELSEIF(AR 

C        ERRAR(1 

C         ERRAR(2 

C        ERRAR(3 

C        ERRAR(4 

C        ERRAR(5 

C        ERRAR(6 

ERRAR(1 

ERRAR(2 

ERRAR(3 

ERRAR(4 

ERRAR(5 

ERRAR(6 

C   ARRAY  7 

ELSEIF(AR 
ERRAR ( 1 
ERRAR(2 
ERRAR ( 3 
ERRAR ( 4 
ERRAR ( 5 
ERRAR (6 
C   ARRAY  8 

ELSEIF(AR 
ERRAR ( 1 
ERRAR (2 
ERRAR (3 
ERRAR (4 
ERRAR (5 
ERRAR (6 
C   ARRAY  9 

ELSEIF(AR 
ERRAR (1 
ERRAR (2 
ERRAR ( 3 
ERRAR (4 
ERRAR ( 5 
ERRAR ( 6 
C   ARRAY  10 

ELSEIF(AR 
ERRAR (1 
ERRAR (2 
ERRAR (3 
ERRAR(4 
ERRAR (5 
ERRAR ( 6 
C   ARRAY  11 

ELSEIF(AR 
ERRAR (1 
ERRAR (2 
ERRAR ( 3 
ERRAR ( 4 
ERRAR ( 5 
ERRAR (6 
C   ARRAY  12 


=  0.0D0 
=  0.0D0 
=  0.0D0 
=  0.0D0 
=  0.0D0 
=    0.0D0 

EQ.6)  THEN 
=-5.0D0 
=  7.0D0 
=  4.0D0 
=  0.005D0 
=  0.002D0 
=-0.003D0 
=  0.0D0 
=  0.0D0 
=  0.0D0 
=  0.0D0 
=  0.0D0 
=  0.0D0 

EQ.7)  THEN 
=  0.0D0 
=  0.0D0 
=  0.0D0 
=  0.0D0 
=  0.0D0 
=  0.0D0 

EQ.8)  THEN 
=  O.ODO 
=  O.ODO 
=  O.ODO 
=  O.ODO 
=  O.ODO 
=  O.ODO 

EQ.9)  THEN 
=  O.ODO 
=  O.ODO 
=  O.ODO 
=  O.ODO 
=  O.ODO 
=  O.ODO 

EQ.10)  THEN 
=  O.ODO 
=  O.ODO 
=  O.ODO 
=  O.ODO 
=  O.ODO 
-  O.ODO 

EQ.ll)  THEN 

■  O.ODO 

=  O.ODO 

=  O.ODO 

=  O.ODO 

=  O.ODO 

=  O.ODO 
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ELSEIF(AR 
ERRAR (1 
ERRAR(2 
ERRAR (3 
ERRAR(4 
ERRAR(5 
ERRAR(6 
C   ARRAY  13 

ELSEIF(AR 
ERRAR(1 
ERRAR(2 
ERRAR(3 
ERRAR(4 
ERRAR(5 
ERRAR(6 
C   ARRAY  14 

ELSEIF(AR 

ERRAR(1 

ERRAR(2 

ERRAR(3 

ERRAR (4 

ERRAR(5 

ERRAR(6 

C        ERRAR(1 

C        ERRAR(2 

C        ERRAR ( 3 

C        ERRAR (4 

C        ERRAR ( 5 

C        ERRAR ( 6 

C   ARRAY  15 

ELSEIF(AR 

ERRAR ( 1 

ERRAR ( 2 

ERRAR (3 

ERRAR(4 

ERRAR (5 

ERRAR ( 6 

C        ERRAR ( 1 

C        ERRAR ( 2 

C        ERRAR (3 

C        ERRAR ( 4 

C        ERRAR ( 5 

C        ERRAR ( 6 

C   ARRAY  16 

ELSEIF(AR 
ERRAR (1 
ERRAR (2 
ERRAR (3 
ERRAR (4 
ERRAR (5 
ERRAR ( 6 
C   ARRAY  17 

ELSEIF(AR 
ERRAR (1 
ERRAR (2 
ERRAR (3 
ERRAR (4 
ERRAR (5 
ERRAR (6 
C   ARRAY  54 

ELSEIF(AR 


EQ.12)  THEN 
=  O.ODO 
=  O.ODO 
=  O.ODO 
=  O.ODO 
=  O.ODO 
=  O.ODO 

EQ.13)  THEN 
=  O.ODO 
=  O.ODO 
=  O.ODO 
=  O.ODO 
=  O.ODO 
=  O.ODO 

EQ.14)  THEN 
=  O.ODO 
=  O.ODO 
=  O.ODO 
=  O.ODO 
=  O.ODO 
=  O.ODO 
=  4.0D0 
=-8.0D0 
=  5.0D0 
=-0.009D0 
=-0.004D0 
=  0.003D0 

EQ.15)  THEN 
=  ll.ODO 
=  28.0D0 
=  -2.0D0 
=  0.025D0 
=  0.010D0 
=-0.010D0 
=  O.ODO 
=  O.ODO 
=  O.ODO 
=  O.ODO 
=  O.ODO 
=  O.ODO 

EQ.16)  THEN 
=  O.ODO 
=  O.ODO 
=  O.ODO 
=  O.ODO 
=  O.ODO 
=  O.ODO 

EQ.17)  THEN 
=  O.ODO 
=  O.ODO 
=  O.ODO 
=  O.ODO 
=  O.ODO 
=  O.ODO 

EQ.54)  THEN 
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ERRAR(l) 

= 

O.ODO 

ERRAR(2) 

= 

0.0D0 

ERRAR(3) 

= 

O.ODO 

ERRAR(4) 

= 

O.ODO 

ERRAR(5; 

= 

O.ODO 

ERRAR(6; 

= 

O.ODO 

c 

ARRAY  55 

ELSEIF(AR. 

EQ 

.55)  THEN 

ERRAR(l) 

= 

O.ODO 

ERRAR(2; 

= 

O.ODO 

ERRAR(3; 

= 

O.ODO 

ERRAR(4; 

= 

O.ODO 

ERRAR(5; 

= 

O.ODO 

ERRAR(6) 

= 

O.ODO 

c 

ARRAY  56 

ELSEIF(AR. 

EQ 

.56)  THEN 

ERRAR (1) 

= 

O.ODO 

ERRAR(2) 

= 

O.ODO 

ERRAR(3) 

= 

O.ODO 

ERRAR ( 4 ) 

= 

O.ODO 

ERRAR ( 5 ) 

= 

O.ODO 

ERRAR ( 6 ) 

= 

O.ODO 

c 

ARRAY  57 

ELSEIF(AR. 

EQ 

.57)  THEN 

ERRAR(l) 

= 

O.ODO 

ERRAR ( 2 ) 

= 

O.ODO 

ERRAR(3) 

= 

O.ODO 

ERRAR (4 

= 

O.ODO 

ERRAR(5; 

= 

O.ODO 

ERRAR ( 6 ) 

= 

O.ODO 

c 

ARRAY  2  3 

ELSEIF(AR. 

EQ 

.23)  THEN 

ERRAR(l) 

= 

O.ODO 

ERRAR ( 2 ) 

= 

O.ODO 

ERRAR(3) 

= 

O.ODO 

ERRAR ( 4 ; 

= 

O.ODO 

ERRAR ( 5 ; 

= 

O.ODO 

ERRAR ( 6 ; 

= 

O.ODO 

c 

ARRAY  24 

ELSEIF(AR. 

EQ 

.24)  THEN 

c 

ERRAR(l) 

=  - 

-0.5DO 

c 

ERRAR(2) 

=- 

-l.ODO 

c 

ERRAR ( 3 ) 

= 

0.7D0 

c 

ERRAR ( 4 ) 

=  ■ 

-0.010D0 

c 

ERRAR ( 5 ) 

= 

0.005D0 

c 

ERRAR ( 6 ) 

=  - 

-0.020D0 

ERRAR ( 1 ) 

= 

O.ODO 

ERRAR ( 2 ) 

= 

O.ODO 

ERRAR ( 3 ) 

= 

O.ODO 

ERRAR ( 4 ) 

= 

O.ODO 

ERRAR ( 5 ) 

= 

O.ODO 

ERRAR(6) 

= 

O.ODO 

c 

ARRAY  2  5 

ELSEIF(AR. 

EQ 

.25)  THEN 

ERRAR(l) 

= 

O.ODO 

ERRAR ( 2 ; 

= 

O.ODO 

ERRAR(3] 

= 

O.ODO 

ERRAR ( 4 ; 

= 

O.ODO 

ERRAR ( 5 ) 

= 

O.ODO 

ERRAR ( 6 ) 

= 

O.ODO 

c 

ARRAY  2  6 
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ELSEIF(AR.EQ 
ERRAR(1 
ERRAR(2 
ERRAR(3 
ERRAR(4 
ERRAR (5 
ERRAR(6 
ARRAY  27 

ELSEIF(AR.EQ. 
ERRAR(1 
ERRAR(2 
ERRAR(3 
ERRAR(4 
ERRAR(5 
ERRAR(6 
ARRAY  28 

ELSEIF(AR.EQ 
ERRAR(1 
ERRAR(2 
ERRAR(3 
ERRAR(4 
ERRAR ( 5 
ERRAR ( 6 
ARRAY  29 

ELSEIF(AR.EQ 
ERRAR ( 1 
ERRAR ( 2 
ERRAR ( 3 
ERRAR (4 
ERRAR (5 
ERRAR (6 

ELSE 

ERRAR ( 1 
ERRAR ( 2 
ERRAR ( 3 
ERRAR ( 4 
ERRAR (5 
ERRAR ( 6 

ERR  =  1 

ENDIF 

RETURN 
100  FORMAT(Al) 

END 


26)  THEN 

0.0D0 

0.0D0 

0.0D0 

0.0D0 

0.0D0 

0.0D0 


27)  THEN 
0.0D0 

0D0 

0D0 

0D0 

0D0 

0D0 


28)  THEN 
0.0D0 
0.0D0 
0.0D0 
0.0D0 
0.0D0 
O.ODO 

29)  THEN 
O.ODO 
O.ODO 
O.ODO 
O.ODO 
O.ODO 
O.ODO 

O.ODO 
O.ODO 
O.ODO 
O.ODO 
O.ODO 
O.ODO 
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APPENDIX  F:   COMPUTER  PROGRAMS  SHIFTER  AND  LONG (BASE) 

These  FORTRAN  programs  are  used  to  determin  the  SBL  and  LBL  poslocs 
for  the  error  correction  methodology. 

SUBROUTINE  SHIFTER (A2 , XTILT, YTILT, ZROT, T, K, NEW, H2 , THONE ) 

Q*  ********************  ***********************  *******************  * 

c 

C  THIS  PROGRAM  IS  A  MODIFICATION  OF  ERRPROP  (08/22/90)  TO 

C  SHIFT  THE  POSLOC  WHEN  THE  ARRAY  IS  MOVED.  THE  ORIGIN  IS  OVER  THE  C- 

C  HYDROPHONE  AND  THE  PROPOSED  SYSTEM  IS  APPLIED.   A2  IS  THE  DEPTH  OF 

C  THE  GEOMETRIC  CENTER  OF  THE  ARRAY  CUBE.   THE  ACOUSTIC  CENTER  IS 

C  THE  C-HYDROPHONE. 

C  TRANSIT  TIME  ERROR. 

C    THIS  IS  FOR  THE  KTH  POSLOC  AS  DEFINED  FROM  THE  SOURCE  PROGRAM 

C    (NEWERR  OR  SETUP) 

C  J. A.  GEMBARSKI 

C  NPS    01/01/92 

Q**************************************************************** 

c 

C  INPUTS: 

C  A2:    DEPTH  OF  THE  CENTER  OF  THE  ARRAY 

C  XTILT, YTILT, ZROT:   ORIENTATION  INFORMATION  ABOUT  THE 

C  SENSING  ARRAY  (RADIANS) 

C  D:     LENGTH  OF  ARRAY  EDGES. 

C  L:     DEPTH  OF  LAYER  BOUNDARIES. 

C  M:      NUMBER  OF  RECORDS  IN  THE  VELOCITY  DEPTH  PROFILE. 

C  VEL:   AVERAGE  SPEED  OF  SOUND  IN  THE  LAYERS. 

C  K:     POSLOC  TO  BE  SHIFTED 

C  T:      RAY  TRANSIT  TIMES  FROM  EACH  HYDROPHONE  X,Y,Z,C 

C 

C  OUTPUTS: 

C  NEW:   LOCAL  COORDINATES  OF  THE  SHIFTED  POSLOC 

C  H2:    THE  HORIZONTAL  RANGE  TO  THE  SHIFTED  POSLOC 

C  THONE: THE  'TRUE1  ELEVATION  ANGLE  TO  THE  SHIFTED  POSLOC 

C 

£**************************************************************** 

DIMENSION  B(5,3) ,DZ(300) , HD ( 5 ) , L ( 300 ) 

DIMENSION  LM(300) ,NEW(3) 

DIMENSION  T(18,4) 

DIMENSION  V0(300) , VI (300) ,VEL(300) , X0 ( 3 ) 

COMMON  /SET1/  L , VEL, V0 , VI , DZ , LM, M 

DOUBLE  PRECISION  B , DZ , HD , L , LM, PHI 
DOUBLE  PRECISION  T, THONE, V0, VI 
DOUBLE  PRECISION  VEL, X0, NEW 

DOUBLE  PRECISION  Al , A2 , A2M, CI, C2 , C3 , CAZ, CX, CX0, CY 

DOUBLE  PRECISION  CY0,CZ,CZ0,D 

DOUBLE  PRECISION  PIE , SI , S2 , S3 , SAZ 

DOUBLE  PRECISION  V, XTILT, YTILT, ZROT 

DOUBLE  PRECISION  H2,Z2,THE 
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INTEGER  K,J,M,N 

PIE  =  DACOS(-l.ODO) 
D  =  30.0DO 

C    FORM  SINES  AND  COSINES  OF  ALL  THE  EULER  ANGLES : ROLL, PITCH, YAW 

52  =  DSIN(XTILT) 

C2  =  DSQRT(1.0  -  S2**2) 

SI  =  DSIN(YTILT)/C2 

CI  =  DSQRT(1.0  -  Sl**2) 

53  =  -DSIN(ZROT) 
C3  =  DCOS(ZROT) 

C  IN  THE  COORDINATE  SYSTEM  HAVING  CENTER  AT  THE  C-HYDROPHONE 
C  AND  POSITIVE-UPWARD,  THE  LOCATIONS  OF  THE  FOUR  HYDROPHONES 
C    (RELATIVE  TO  THE  ARM  LENGTH  D)  ARE  DEVELOPED  NEXT. 

B(l, 1)  =  C2*C3 

B(l,2)  =  C2*S3 

B(l,3)  =  S2 

B(2,l)  =  -S1*S2*C3  -  C1*S3 

B(2,2)  =  -S1*S2*S3  +  C1*C3 

B(2,3)  =  S1*C2 

B(3,l)  =  -C1*S2*C3  +  S1*S3 

B(3,2)  =  -C1*S2*S3  -  S1*C3 

B(3,3)  =  C1*C2 

C    LIKE  NOTATION  WILL  BE  USED  TO  LOCATE  THE  C-HYDROPHONE  AND  THE 
C    ARRAY  CENTER. 

DO  12  J  =  1,3 

B(4,J)  =  0.0D0 

B(5,J)  =  0.5*(B(J,1)  +  B(J,2)  +  B(J,3)) 
12   CONTINUE 

Al  =  0.0D0 


DETERMINE  THE  DEPTHS  OF  THE  FOUR  HYDROPHONES  AND  THE  ARRAY  CENTER. 
HD(1)  =  A2  +  D*(B(5,3)  -  B(l,3)) 
HD(2)  =  A2  +  D*(B(5,3)  -  B(2,3)) 
HD(3)  =  A2  +  D*(B(5,3)  -  B(3,3)) 
HD(4)  =  A2  +  D*(B(5,3)  -  B(4,3)) 
HD(5)  =  A2 

FIND  THE  DEEPEST  HYDROPHONE 
A2M  =  0.D0 
DO  51  J=l,4 
IF(HD( J) .GT.A2M)  A2M  =  HD(J) 
51   CONTINUE 

LOCATE  THE  WATER  LAYER,  N,  CONTAINING  THE  ARRAY. 
N  =  M 
DO  37  J  =  2,M 

IF( (LM(J-l) .LE.HD(4) ) .AND. (LM(J) .GT.HD(4) ) )  N  =  J-l 
37   CONTINUE 

IF(N.GE.M)THEN 

PRINT*, *C  HYDROPHONE  IS  DEEPER  THAN  CURRENT  DEPTH-VELOCITY' 

PRINT*, 'PROFILE.  PROGRAM  TERMINATED  IN  SHIFT  SUBROUTINE' 

PRINT*, 'POSLOC  NUMBER ',K 

STOP 
ENDIF 
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V  =  VO(N)  +  V1(N)*HD(4) 

C    CALCULATE  THE  PRE-TILT  CORRECTED  APPARENT  POSITION 
C  WRITE(44,221)K 

DO  40  J  =  1,3 

X0(J)=(D**2  +  (V*T(K,4)-V*T(K, J) ) * ( V*T (K, 4 ) +V*T(K, J) ) )/(2*D) 
C  WRITE(44,222)  J,X0(J) 

40      CONTINUE 

C    COMPUTE  DIRECTION  COSINES  . 

CXO  =  X0(1)/(V*T(K,4) ) 

CYO  =  X0(2)/(V*T(K,4) ) 

CZO  =  DSQRT(1.0  -  CX0**2  -  CY0**2) 
C         WRITE(44,223)CX0/CY0,CZ0 

C    PERFORM  EXACT  TILT  CORRECTIONS  AND  THE  ROTATIONAL  ALIGNMENT. 
42      CX  =  B(1,1)*CX0  +  B(2,1)*CY0  +  B(3,1)*CZ0 

CY  =  B(1,2)*CX0  +  B(2,2)*CY0  +  B(3,2)*CZ0 

CZ  =  B(1,3)*CX0  +  B(2,3)*CY0  +  B(3,3)*CZ0 
C         WRITE(44,224)CX,CY,CZ 

SAZ  =  CY/DSQRT(CX**2  +  CY**2) 

CAZ  =  CX/DSQRT(CX**2  +  CY**2) 
C         WRITE(44,225)SAZ,CAZ 

PHI  =  DATAN2 ( SAZ , CAZ ) 

THONE  =  0.5*PIE  -  DACOS(CZ) 
C         WRITE (44, 226) PHI, THONE 

49      CALL  ISOGADl(Al,HD(4) ,T(K,4) , THONE, N, LM,VEL,V0, VI , DZ , H2 , 
*  Z2,THE) 

NEW(l)  =  H2*CAZ 
NEW(2)  =  H2*SAZ 
NEW(3)  =  Z2 

RETURN 

221  FORMAT ( 5X, ' POSLOC  NUMBER   ',12/) 

222  FORMAT(10X, ' XO ' , I1,F11.4) 

223  FORMAT  (/10X,  'CXO  ',F11.4,'   CYO  '^11.4, '  CZO  ',F11.4) 

224  FORMAT (1 OX, 'CX   ,,F11.4/'   CY   ,,F11.4/'  CZ   ',F11.4) 

225  FORMAT(/10X, 'SAZ  ',F11.4,'   CAZ  ',F11.4) 

226  FORMAT(/10X, ' FM  SHIFT  PH  ',F11.4,'   TH  ',F11.4) 
END 
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*********************************************************************** 
SUBROUTINE  LONG (TIME , LINKS , SENSR , CPH , K , XS , HD , THONE , TH , PHS , PHL , HO , 
&  XL) 

c 

C  12/19/90 

C  LONGBASE.FOR  IS  A  LONG  BASE  LINE  METHOD  FOR  TRIPLE  CROSSOVER  REGIONS 

C  THIS  IS  A  MODIFIED  VERSION  OF  LONGBASE  FROM  REF  3.   WHEN  DETERMINING 

C  THE  ARRAY  TO  UPDATE  (DH)  A  TOLERANCE  LIMIT  WAS  PLACED  ON  THE  CLOSEST 

C  POSLOC  DISTANCE  SUCH  THAT  IF  WITHIN  EPS  CHOOSE  ARRAY  1  (INTERIOR)  TO 

C  UPDATE . 

C  J. A.  GEMBARSKI 

C  NPS    01/01/92 

c 

C  A1,A2,A3  are  the  location  of  the  C-Hydrophones. 

C  Al ( I )  is  the  downrange  location  of  the  3  arrays. 

C  A2 ( I )  is  the  crossrange  location  of  the  3  arrays. 

C  A3 ( I )  is  the  depth  location  of  the  3  arrays. 

C  (  Depth  is  positive  down  orientation  ) . 

C  K     IS  THE  OVERLAP  REGION  OF  INTEREST 

C  THONE  IS  THE  INITIAL  ELEVATION  ANGLES  TO  THE  SBL  POSLOCS 

C  HD    IS  THE  HORIZONTAL  DISTANCE  TO  THE  SBL  POSLOCS 

C  OUTPUTS 

C  TH    ELEVATION  ANGLES  TO  THE  LONGBASE  POSLOCS 

C  PHS/PHL   AZIMUTHS  TO  THE  SBL/LBL  POSLOCS 

C  HO    HORIZONTAL  RANGE  TO  THE  LBL  POSLOCS 

C  XL    LBL  POSLOC  COORDINATES 

*********************************************************************** 

DIMENSION  A1(3),A2(3),A3(3),X(3),Y(3),Z(3) ,TH0(3) ,T(3) 

DIMENSION  H(3) ,AR1(2) , AR2 (2 ) ,HD(18) , PHO ( 3 ) ,PH1(3) 

DIMENSION  XX(3) , YY ( 3 ) , AR ( 4 ) ,LM(300) ,DZ(300) , VI (300) 

DIMENSION  L(300) ,VEL(300) , V0 ( 300 ) , XL ( 6 , 3 ) , THONE (18) ,HO(18) 

DIMENSION  PHS (18) , PHL ( 18) ,TH(18) , CPH ( 7 , 3 ) ,XS(18, 3) 

DIMENSION  LINKS (18) ,SENSR(7) , TIME (18, 4) 

COMMON  /SET1/  L , VEL, V0 , VI , DZ , LM, M 

DOUBLE  PRECISION  L, VEL, V0 , VI , DZ , LM, HO, PHS, PHL, TH 

DOUBLE  PRECISION  Al , A2 , A3 , X, Y, Z , DZ0, TH0 , T, Z0 , ZOO, H 

DOUBLE  PRECISION  D12 , D13 , D23 , AR1 , AR2 , Dl , D2 , D3 , HD, PHO, PHI , XL 

DOUBLE  PRECISION  VA, VB , UA, UB , EPS , XX, YY , DS , DM, GAM , THONE , TIME , CPH, XS 

INTEGER    DL1, DL2 , DH, MARR, AR, ERR, K, LINKS, SENSR, I,M,N 

EPS  =  1D-3 
ERR  =  0 

C   GAM  is  a  convergence  tuning  constant. 
GAM  =  5.0D0 

N  =  (3*K)-3 
DO  10  I  =1,3 

A1(I)  =  CPH(LINKS(I+N) ,1) 

A2(I)  =  CPH(LINKS(I+N) ,2) 

A3(I)  =  CPH(LINKS(I+N) ,3) 

X(I)   =  XS(I+N, 1) 

Y(I)   =  XS(I+N,2) 

Z(I)   =  XS(I+N,3) 

H(I)   =  HD(I+N) 

TH0(I)  =  THONE (I+N) 

T(I)  =  TIME(I+N,4) 
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AR(I)  =  SENSR(LINKS(I+N) ) 
10  CONTINUE 


C  Compute  the  max  dz. 

DZO  =  MAX(DABS(Z(1)-Z(2) ) , DABS ( Z ( 1 ) -Z ( 3 ) ) , DABS ( Z (2 ) -Z ( 3 ) ) ) 

DO  70  I  =  1,3 

PHO(I)  =  DATAN2(Y(I)-A2(I) ,X(I)-A1(I) ) 
70   CONTINUE 

C  WRITE(3,280)AR(1) ,AR(2) ,AR(3) ,AR(4) 

C  WRITE(3,250)A1(1) ,A2(1) ,A3(1) 

C  WRITE(3,251)A1(2) ,A2(2) ,A3(2) 

C  WRITE(3,252)A1(3) ,A2(3) , A3 ( 3 ) 

C  WRITE(3,270)X(1) ,Y(1)  ,Z(1) 

C  WRITE(3,271)X(2) ,Y(2)  ,Z(2) 

C  WRITE(3,272)X(3) ,Y(3)  ,Z(3) 

C  WRITE (3,*) ' 

C  WRITE(3,253)H(1) ,H(2) ,H(3) 

D12  =  DSQRT( (X(2)-A1(1) )**2  +  ( Y ( 2 ) -A2 ( 1 ) ) **2 ) 
D13  =  DSQRT( (X(3)-A1(1) )**2  +  ( Y ( 3 ) -A2 ( 1 ) ) **2 ) 
IF  ( (D12.GE.H(1) ) .OR. (D13.GE.H(1) ) )  THEN 

Z0  =  MAX(Z(1) ,Z(2) ,Z(3)  ) 
ELSE 

ZO  =  MIN(Z(1) ,Z(2) ,Z(3) ) 
ENDIF 

DO  7  5  I  =  1,3 
75    IF(Z(I) .EQ.ZO)  MARR  =  I 
C      WRITE(3,254)DS,Z0 

GOTO  720 

80  Dl  =  DSQRT( (UA-Al(DH) )**2  +  ( VA-A2 (DH) ) **2 ) 

D2  =  DSQRT( (UB-A1 (DH) ) **2    +  ( VB-A2 (DH) ) **2 ) 
D3  =  MIN(D1,D2) 
C      WRITE(3,287)  D1,D2 

IF(DABS(H(DH)  -  D3).LT.EPS)  GOTO  100 

ZOO  =  ZO 
C      RDH  =  DSQRT(H(DH)**2  +  ( A3 (DH) -ZO ) **2 ) 

ZO  =  ZOO  +  (A3(DH)  -  Z00)*(1  -  H (DH) /D3 ) *GAM 
DS  =  D3  -  H(DH) 

C      WRITE(3,254)DS,Z0 
C      WRITE(3,253)H(1) ,H(2) ,H(3) 
720  CONTINUE 

DO  90  I  =  1,3 

IF  (I.EQ.MARR)  GOTO  90 

CALL  NEWLOC ( 0 . 0D0 , A3 ( I ) , THO (I),T(I),H(I),Z(I),ZO) 
90  CONTINUE 

IF(MARR.EQ.4)  GOTO  98 

C  Adjust  POSLOCs  for  new  horizontal  ranges. 
DO  95  I  =  1,3 

IF (I.EQ.MARR)  THEN 
XX(I)  =  X(I) 
YY(I)  =  Y(I) 
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ELSE 

XX (I)  =  A1(I)  +  H(I)*DCOS(PH0(I) ) 
YY(I)  =  A2(I)  +  H(I)*DSIN(PHO(I) ) 

ENDIF 
95   CONTINUE 

C   Find  the  two  closest  POSLOCs. 

D12  =  DSQRT( (XX(1)  -  XX(2))**2  +  (YY(1)  -  YY(2))**2) 
D13  =  DSQRT((XX(1)  -  XX(3))**2  +  (YY(1)  -  YY(3))**2) 
D23  =  DSQRT((XX(2)  -  XX{3))**2  +  (YY(2)  -  YY(3))**2) 
DM  =  MIN(D12,D13,D23) 
C      WRITE(3,288)D12,D13,D23 
IF(DM.LT.EPS)  DM  =  D23 
IF(DM.EQ.D23)  THEN 

DL1  =  2 

DL2  =  3 

DH  =  1 
ELSEIF(DM.EQ.D13)  THEN 

DL1  =  1 

DL2  =  3 

DH  =  2 
ELSE 

DL1  =  1 

DL2  =  2 

DH  =  3 
ENDIF 
C      WRITE(3,255)DH,GAM 

MARR  =  4 

AR1(1)  =  Al(DLl) 

AR2(1)  =  A2 (DL1) 

AR1(2)  =  A1(DL2) 

AR2(2)  =  A2(DL2) 

98   CALL  CIRCS0LV(AR1,AR2,H(DL1) ,H(DL2) ,UA,VA,UB,VB) 
C      WRITE(3,285)UA,VA 
C      WRITE(3,286)UB,VB 
GOTO  80 

100  CONTINUE 

IF(D3.EQ.D2)  THEN 

VA  =  VB 

UA  =  UB 
ENDIF 
C      WRITE(3,260)UA,VA,Z0 

XL(K,1)  =  UA 

XL(K,2)  =  VA 

XL(K,3)  =  Z0 

DO  110  I  =  1,3 

HO(I+N)  =  H(I) 

PHO(I)  =  DATAN2(Y(I)-A2(I) , X ( I ) -Al ( I ) ) 

PHI (I)  =  DATAN2(VA-A2(I) ,UA-A1(I) ) 

TH(I+N)  =  THO(I) 

PHS(I+N)  =  PHO(I) 

PHL(I+N)  =  PH1(I) 
C         WRITE(3,261)AR(I) , PHO ( I ) ,PH1(I) 
C         WRITE(3,262)THONE(I+N) ,TH0(I) 
110  CONTINUE 
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250 
251 
252 
253 
254 
255 
260 

261 
262 
270 
271 
272 
280 
285 
286 
287 
288 

C*** 


RETURN 

FORMAT 
FORMAT 
FORMAT 
FORMAT 
FORMAT 
FORMAT 
FORMAT 
t 

FORMAT 
FORMAT 
FORMAT 
FORMAT 
FORMAT 
FORMAT 
FORMAT 
FORMAT 
FORMAT 
FORMAT 
END 


(/10X 

(10X, 
(10X, 
(10X, 
(/10X 
(/10X 
(//10X 

F10 
(/10X 
(21X, 
(/10X 
(10X, 
(10X, 
(10X, 
(/10X 
(10X, 
(/10X 
(/10X 


#• 


•Al(l)= 
Al(2)=- 
Al(3)=' 
H(l)  =  \ 

•DS   =' 

•DH  =  ■ 
,  *U 
2) 

•ARR 
THOO  = 

'X(l) 
X(2)  = 
X(3)  = 
ARRAYS 

•UA  = 
UB  =  ' 

•Dl  = 

•D12  = 


',F10.2, 
,F10.2, ' 
,F10.2,' 
F11.4, ' 
,F11.4, ' 
,12,' 
',F10.2, 

,12,' 

' ,F10.6, 
\F10.2, 
,F10.2, 
,F10.2, 
',12,  ', 
,F10.2, 
F10.2,  ' 
,F11.4, 
' ,F11.6 


A2(l)=' ,F10.2, 
A2(2)=' ,F10.2, ' 
A2(3)=' ,F10.2, ' 
H(2)=',F11.4, ' 
ZO   =',F11.4) 
GAM  =  ' ,F4.1) 
V  =' ,F10.2, ' 


PHO 


A3(l)=' ,F10.2) 
A3(2)=' ,F10.2) 
A3(3)=' ,F10.2) 
H(3)=',F11.4) 


ZO  ='  , 


=  ' ,F10.6, ' 
THO  =  ' ,F10.6) 
Y(l)  =' ,F10.2, ' 
Y(2)  =' ,F10.2, ' 
Y(3)  =' ,F10.2, ' 
12, ' ,  and  * ,12, 7X, 

VA  =' ,F10.2) 
VB  =' ,F10.2) 
D2  =  '  ,F11.4) 
D13  =  ' ,F11.6, ' 


PHI  =  ' ,F10.6) 
Z(l)  =',F10.2) 


Z(2) 
Z(3) 
CASE 


=' ,F10.2) 
=' ,F10.2) 
M2) 


D23  =  ' f F11.6) 


***************************************************************** 


SUBROUTINE  NEWLOC ( Al , A2 , THO , T, HO , Z , ZO) 


C 

c 
c 
c 
c 
c 
c 
c 
c 
c 
c 

C  OUTPUTS 


INPUTS: 
Al: 
A2: 
M: 

THO: 
T: 
HO: 
Z: 
ZO: 


THP: 


HORIZONTAL  COORDINATE  OF  SENSOR 

VERTICAL  COORDINATE  OF  SENSOR,  POSITIVE  DOWN 

INDEX  OF  DEEPEST  LAYER  USED 

ELEVATION  ANGLE 

TRANSIT  TIME 

HORIZONTAL  RANGE 

DEPTH  OF  POSLOC 

DEPTH  GOAL 


ADJUSTED  ELEVATION  ANGLE 


DIMENSION  L(300) ,VEL(300) , VO ( 300 ) , VI ( 300 ) , DZ ( 300 ) , LM( 300 ) 

COMMON  /SET1/  L, VEL, VO, VI , DZ , LM, M 

DOUBLE  PRECISION  L, VEL, VO, VI , DZ , LM 

DOUBLE  PRECISION  THO , T, HO , Z , ZO , THP , EPS , Al , A2 , TH1 

INTEGER  J,M,N 

compute  the  slant  range 
EPS  =  .0010D0 
DO  5  J  =  2,M 

IF( (LM(J-l) .LE.A2) .AND. (LM(J) .GT.A2) )  N  =  J-l 
PRINT*, 'N' ,N, 'A2 ' ,A2, 'LMJ-1' , LM(J-l) , ' LM J ' ,LM(J) 
5   CONTINUE 

THP  =  THO 
10   CONTINUE 

THP  =  THP  -  (Z0-Z)/H0 

PRINT*, ' N' ,N 

CALL  ISOGAD1(A1,A2,T,THP,N,LM,VEL,VO,V1,DZ,HO,Z,TH1) 

IF  (DABS(Z-ZO) .GE.EPS)  GOTO  10 

THO  =  THP 
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RETURN 
END 

q*  *************  ****************** **************  *******  ***********  ** 
subroutine  circsolv ( al , a2 , hi , h2 , ul , vi , u2 , v2 ) 

c 

C   INPUTS: 

C      Al:  CENTER  OF  THE  1ST  CIRCLE 

C      A2:  CENTER  OF  THE  2ND  CIRCLE 

C      H1,H2:   RADIUS 

C   OUTPUTS: 

C      U1,V1:   1ST  INTERSECTION  POINT 

C      U2,V2:   2ND  INTERSECTION  POINT 

c 

DIMENSION  A1(2),A2(2) 

DOUBLE  PRECISION  Al , A2 , BO, Bl , HI , H2 , Ul , U2 , VI , V2 , PI, P2 , P3 , B2 

INTEGER    ERR 

ERR  =  0 

BO  =  Hl**2  -  H2**2  +  Al(2)**2  -  Al(l)**2  +  A2(2)**2  -  A2(l)**2 

Bl  =  2*(A1(2)  -  Al(l) ) 

B2  =  2*(A2(2)  -  A2(l) ) 

Bl  =  -B1/B2 

BO  =  B0/B2 

PI  =  1+B1**2 

P2  =  2*B1*(B0-A2 (1) )-2*Al(l) 

P3  =  Al(l)**2  +  (B0-A2 (1) )**2  -  Hl**2 

CALL  QUAD(P1,P2,P3,U1,U2,ERR) 

IF  (ERR.EQ.l)  THEN 

WRITE (*,*)'   THERE  WAS  AN  ERROR  IN  QUAD  SOLUTION' 

STOP 
ENDIF 

VI  =  BO  +  B1*U1 
V2  =  BO  +  B1*U2 
RETURN 
END 

q*  *******************************************************************  * 

SUBROUTINE  QUAD ( A, B, C, XI , X2 , ERR) 
c 

DOUBLE  PRECISION  A, B, C, D, XI ,X2 

INTEGER    ERR 

D  =  B**2  -  4.0*A*C 
IF  (D.LT.O.ODO)  THEN 

ERR  =  1 

GOTO  10 
ENDIF 

XI  =  (-B  +  DSQRT(D) )/(2.0*A) 
X2  =  (-B  -  DSQRT(D) )/(2.0*A) 
10   RETURN 
END 
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APPENDIX  G:   COMPUTER  PROGRAM  VELPRO 

The  VELPRO  program  sets  up  the  water  column  for  use  in  RAYFIT  and 
ISOGAD  subroutines.  It  also  performs  any  DVP  extrapolation  required  if  an 
array  hydrophone  should  exceed  the  deepest  depth  of  the  current  profile. 
The  extrapolation  control  can  be  overridden  from  the  calling  program. 


SUBROUT INE  VELPRO ( OP , NAME 1 , N , EXT , A2 ) 

THIS  A  COMBINATION  OF  FORTRAN  PROGRAMS  VELMOD  (2/22/90)  AND 
ERRPROP  (8/22/90)  IN  LIB12.FOR  OF  REF  1. 
-  A  CORRECTION  WAS  MADE  TO  THE  EXTRAPOLATION  PROCEDURE  FROM  ERRPROP 
IN  THE  TERM  GG .   THE  FACTOR  OF  21  WAS  INADVERTENTLY  LEFT  OUT  OF 
THE  DENOMINATOR  IN  THE  ORIGINAL  PROGRAM. 
THIS  SUBROUTINE  READS  IN  THE  DEPTH  VELOCITY  PROFILE  AND  THEN 
PERFORMS  A  DEPTH  EXTENSION  IF  A2  IS  DEEPER  THAN  THE  LAST  LAYER 

J. A.  GEMBARSKI 
NPS    01/01/92 

DIMENSION  L(300) ,VEL(300) , V0 ( 300 ) , VI ( 300 ) , DZ(300) ,LM(300) 

COMMON  /SET1/  L , VEL, V0 , VI , DZ , LM, M 

DOUBLE  PRECISION     L, VEL , LM , DZ , V0 , VI , K0 , G , GG, SV, SVU2 , SVU, SU2 , SU4 
DOUBLE  PRECISION     U,LB,A2 
INTEGER    EXT,M,OP,N 
CHARACTER* 15  NAME1 

IF  (EXT.EQ.l)  GOTO   111 

READ  IN  THE  DEPTH  AND  VELOCITY  ARRAYS 


IF 
IF 
IF 
IF 
IF 
IF 
IF 
IF 
IF 
IF 
IF 
IF 
IF 
IF 
IF 
IF 
IF 
IF 


;n.eq. 1 
;n.eq.2 
;n.eq.3 
;n.eq.4 
;n.eq. 5 
;n.eq.6 
;n.eq.7 
;n.eq.8 

N.EQ. 9 
N.EQ. 10 
N.EQ. 11 
N.EQ. 12 
N.EQ. 13 
N.EQ. 14 
; N.EQ. 15 
[OP.EQ.l 
[OP.EQ.l 
(OP.EQ.l 
OPEN(UNIT=4 
1  =  1 
CONTINUE 


NAME1  =  '/ON880512  DVT  A' 
NAME1  =  '/ON880622  DVT  A1 
NAME1  =  '/ON880721  DVT  A' 
NAME1  =  ' /ON880803  DVT  A' 
NAME1  =  ' /ON881027  DVT  A" 
NAME1  =  '/ON890113  DVT  A' 
NAME1  =  '/ON890308  DVT  A" 
NAME1  =  '/ON890322  DVT  A' 
NAME1  =  '/ON890426  DVT  A1 

NAME1  =  ' /ONTEST0   DVT  A" 

NAME1  =  ' /ONTEST2   DVT  A" 

NAME1  =  ' /ONTEST4   DVT  A' 

NAME1  =  '/ONTEST6   DVT  A' 

NAME1  =  ' /ONTEST8   DVT  A' 

NAME1  =  ' /ONTEST83  DVT  A' 
PRINT*,   'LOAD  VELOCITY  FILE:  ' ,NAME1 
WRITE (91,*) 'LOAD  VELOCITY  FILE:  ',NAME1 
WRITE (92,*) 'LOAD  VELOCITY  FILE:  ',NAME1 
, FILE=NAME1 , STATUS= ' OLD ' ) 
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READ (4, 130,ERR=7,END=10)L(I) , VEL ( I ) 
L(I)  =  -L(I) 
I  =  1  +  1 
GOTO  5 
7   WRITE (*,*)'        1  THERE  WAS  AN  ERROR  READING  THE  FILE  !' 
STOP 
10   CONTINUE 

CLOSE (UNIT=4) 
M  =  1-1 
* 

*  FORM  THE  SET  OF  LAYER  MIDPOINTS 

* 

DO  40  1=1, M-l 

LM(I)  =  .5*(L(I)  +  L(I+1) ) 
40  CONTINUE 

* 

*  FORM  DEPTH  INCREMENTS,  AND  ALL  SOUND  VELOCITY  SLOPES  AND  INTERCEPTS 
* 

DO  50  1=1, M-2 

DZ(I)  =  LM(I+1)  -  LM(I) 

V0(I)  =  (LM(I+1)*VEL(I)  -  LM(I)*VEL(I+1) )/DZ(I) 
V1(I)  =  (VEL(I+1)  -  VEL(I) )/DZ(I) 
50  CONTINUE 

LM(M)  =  LM(M-l)  +  DZ(M-2) 
130   FORMAT(5X,D8.2,5X,D7.2) 

111    IF(A2.LT.LM(M-1)  .OR.  EXT.EQ.2)  GOTO  126 

C    EXTRAPOLATE 

C    THE  SOUND  VELOCITY  PROFILE  BY  USING  A  QUADRATIC  FUNCTION  OVER 

C    THE  DEEPEST  100  FEET. 

C    FIRST  COUNT  THE  NUMBER  OF  LAYERS  (OF  THICKNESS  DZ(M-2))  TO 
C    BE  ADJOINED.   ALSO  MUST  EXTEND  THE  L  ARRAY. 

K0  =  2  +  MAX(0,NINT( (A2-LM(M-1) )/DZ(M-2) ) ) 

C    FIND  AVERAGE  DEPTH  OF  LAST  100  FEET. 
LB  =  0.0D0 
DO  43  I  =  M-21,M-1 
LB  =  LB  +  LM(I) 
43   CONTINUE 

LB  =  LB/21 

C    FORM  SUMS  OF  POWERS  AND  PRODUCTS. 
SV  =  0.0D0 
SVU2  =  0.0D0 
SVU  =  0.0D0 
SU2  =  0.0D0 
SU4  =  0.0D0 
DO  45  I  =  M-21,M-1 

U  =  LM(I)  -  LB 

SV  =  SV  +  VEL(I) 

SVU  =  SVU  +  U*VEL(I) 

SVU2  =  SVU2  +  U**2  *  VEL(I) 

SU2  =  SU2  +  U**2 

SU4  =  SU4  +  U**4 
45   CONTINUE 

G  =  SVU/SU2 

GG  =  (21*SVU2  -  SU2*SV)/(21*SU4  -  SU2**2) 
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Vl(M-l)  =  G 

C    PERFORM  THE  EXTRAPOLATION. 
DO  125  I=M,M+KO 

Vl(I-l)  =  Vl(I-2)  +  GG*DZ(M-2) 
LM(I)  =  LM(I-l)  +  DZ(M-2) 
VEL(I)  =  VEL(I-l)  +  DZ(M-2)*V1(I-1) 

VO(I-l)  =  (LM(I)*VEL(I-1)  -  LM(I-1)*VEL(I) )/DZ(M-2) 
L(I+1)  =  L(I)  +  DZ(M-2) 
DZ(I-l)  =  DZ(M-2) 
125  CONTINUE 

C   UPDATE  M,  THE  NUMBER  OF  LAYERS 

M  =  M  +  KO 

12  6  CONTINUE 
RETURN 
END 
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APPENDIX  H:   REGIONAL  POSLOC  DATA  (INTERIOR  ARRAY  15)  FOR  RANGE  CORRECTION 


REGIONAL  POSLOC  DATA  INTERIOR  ARRAY  15 
SATELLITE  ARRAYS  WITH  ERRORS  -  ISOSPEED 


ARRAY  15  SBL 

X  49520.90 

Y  -8605.20 

Z  425.14 

THS  0.20431 

THL  0.20347 

PHS  -2.59788 

PHL  -2.60237 

HS  4364.28 

HL  4365.04 


REGION   13 

ARRAY  14  SBL 

49487.10 

-8607.33 

375.98 

0.21783 

0.20578 

-0.50234 

-0.49611 

4376.90 

4388.25 


ARRAY  24  SBL 
49482.90 
-8590.08 
424.18 
0.20157 
0.20051 
1.58702 
1.58078 
4367.09 
4368.03 


LONGBASE 
49510.14 
-8588.79 
428.80 


GOAL 
49493.30 
-8593.79 
400.00 


ARRAY  15  SBL 

X  49390.02 

Y  -4369.35 

Z  417.28 

THS  0.20704 

THL  0.21397 

PHS  2.66863 

PHL  2.66552 

HS  4342.51 

HL  4336.08 


REGION   14 

ARRAY   5  SBL 

49412.46 

-4360.42 

386.64 

0.21490 

0.21477 

-1.59600 

-1.59845 

4317.04 

4317.16 


ARRAY  14  SBL 
49407.20 
-4370.22 
385.75 
0.21855 
0.21821 
0.51579 
0.51840 
4318.03 
4318.35 


LONGBASE 
49401.91 
-4360.26 
387.20 


GOAL 
49404.92 
-4356.84 
400.00 


ARRAY  15  SBL 

X  53197.79 

Y  -2059.94 

Z  389.46 

THS  0.21580 

THL  0.22656 

PHS  1.58433 

PHL  1.57415 

HS  4287.92 

HL  4277.56 


REGION   15 
ARRAY   5  SBL 
53245.52 
-2093.16 
408.91 
0.21317 
0.22861 
-0.50286 
-0.49851 
4250.41 
4235.70 


ARRAY   6  SBL 
53236.15 
-2091.73 
411.46 
0.21216 
0.22820 
-2.63156 
-2.63544 
4250.74 
4235.51 


LONGBASE 
53241.45 
-2069.93 
343.39 


GOAL 
53235.75 
-2085.69 
400.00 


ARRAY  15  SBL 

X  57039.28 

Y  -4266.55 

Z  370.65 

THS  0.21850 

THL  0.21495 

PHS  0.50285 

PHL  0.48858 

HS  4317.97 

HL  4321.34 


REGION   21 
ARRAY   6  SBL 
57062.13 
-4325.19 
412.73 
0.20903 
0.21524 
-1.54383 
-1.54160 
4310.26 
4304.50 


ARRAY  16  SBL 
57062.38 
-4325.69 
409.32 
0.21008 
0.21547 
2.65266 
2.65032 
4330.69 
4325.65 


LONGBASE 
57071.57 
-4319.17 
385.99 


GOAL 
57054.98 
-4330.68 
400.00 


REGION   22 
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ARRAY  15  SBL     ARRAY  16  SBL     ARRAY  25  SBL     LONGBASE       GOAL 


X 

57081.17 

57057.44 

57056.64 

57053.99 

57054.15 

Y 

-8523.61 

-8582.94 

-8588.56 

-8586.27 

-8587.96 

Z 

379.08 

394.12 

404.19 

416.36 

400.00 

THS 

0.21267 

0.20893 

0.18296 

THL 

0.20421 

0.20391 

0.18021 

PHS 

-0.51722 

-2.61546 

1.55218 

PHL 

-0.53262 

-2.61520 

1.55279 

HS 

4401.01 

4426.93 

4416.72 

HL 

4408.89 

4431.59 
REGION   2  3 

4418.96 

ARRAY  15  SBL 

ARRAY  24  SBL 

ARRAY  25  SBL 

LONGBASE 

GOAL 

X 

53341.65 

53288.99 

53293.50 

53294.50 

53293.11 

Y 

-10680.56 

-10692.31 

-10704.16 

-10690.85 

-10707.34 

Z 

406.18 

425.32 

418.14 

452.52 

400.00 

THS 

0.20989 

0.20128 

0.18299 

THL 

0.19921 

0.19505 

0.17508 

PHS 

-1.55099 

0.54496 

2.58304 

PHL 

-1.56189 

0.54459 

2.58032 

HS 

4333.94 

4367.96 

4340.60 

HL 

4343.55 

4373.42 

4346.82 
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APPENDIX  I:   FORMULATION  OF  THE  PROBLEM  AS  A  NONLINEAR  PROGRAM 
AND  ALGORITHM  CHOICE 

Using  the  objective  function  defined  in  Ch.  Ill,  the 

mathematical  formulation  for  the  array  locational  correction 

problem  is  stated  as  follows: 

INDICES: 

i      coordinate  index 

j      triple  overlap  region  index,  j=l,...,NRk 

k      sensor  array  index 

GIVEN  DATA: 

{X°kl}  initial  position  (x,y,z)  for  array  k  for  i=l,2,3 
{A°kl}  initial  orientation  (xtilt,ytilt,  zrot)  for  array 

k  for  1=1,2,3 
NRk   number  of  triple  overlap  regions  for  array  k 
v(z)   the  DVP  of  the  water  as  a  function  of  depth 
t     the  transit  times  of  the  acoustic  pings 

VARIABLES: 

Decision: 

SHIFTkl  =  location  shift  (x,y , z , xtilt , ytilt , zrot)  for 
array  k  for  i=l,...,6 

Internal : 

{ZERkj}   =  depth  error  (z)  for  array  k  in  region  j 
{HER^}  =  horizontal  range  error  for  array  k  in  region 

j 
{PHERkj}  =  azimuth  angle  error  for  array  k  in  region 

j 

{XSkjl}  =  SBL  posloc  (x,y,z)  from  array  k  in  region  j 
for  i=l,2,3,  this  is  a  function  the  arrays 
location  (decision  variables) ,  the  DVP  and 
transit  time,  evaluated  through  the  ray 
tracing  algorithms 

{XLkjl}=  LBL  posloc  (x,y,z)  from  array  k  in  region  j 
for  i=l,2,3,  this  is  a  similar  function  to  the 
above,  but  uses  three  independent  arrays 
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{HI^j}  =  horizontal  range  from  array  k  to  LBL  posloc 

in  region  j 
{HSkj}  =  horizontal  range  from  array  k  to  SBL  posloc 

in  region  j 
{PHL^}  =  azimuth  angle  from  array  k  to  LBL  posloc  in 

region  j 
{PHSkj}  =  azimuth  angle  from  array  k  to  SBL  posloc  in 

region  j 


CONSTRAINTS 


HLkij     =    ^XL2kij:1  +  XL2kijt2  for  all  k,j 


HSkj     =    ^XS2kijil  +  XS2kiji2  for  all  k,j 

f(v(z),t)  =  this  function  is  used  to  construct  the 
acoustic  ray  path 

XSkjl   =   f,  (Xkl/Akl;  f  (v(z)  ,t)) 

for  all  k,j  i=l,2,3 
(this  function  is  evaluated  using  the  iterative  ray 
tracing  algorithms  [Ref.  1]) 

XI*^   =   f2((Xkl/Akl)j;  f  (v(z)  ,t)) 

for  all  k,j  i=l,2,3 
(this  function  is  similar  to  the  above  (fj)  ,  but  uses 
three  independent  arrays,  for  region  j,  in  the  posloc 
evaluation  [Ref.  3]) 

HERkj    =   HL^  -  HSkj  for  all  k,j 

ZERkj    =   XL.^3   -  XSkj3  for  all  k,j 

PHL^   =   arctan[  (XI4Ji2-Xu)  /  (XL^.-X,,,)  ] 

for  all  k,j   i=l,2,3 

PHSkj   =   arctan[  (XSkj2-Xk2)  /  (XSkjl-Xkl)  ] 

for   all   k,j      i=l,2,3 

PHER^      =      PHLkj    -    PHSkj  for    all    k,j 


Xkl  =      X°kl   +    SHIFTkl  for    all    k,     i=l,2,3 

Au  -      A\,   +    SHIFTk'(,+3)  for    a11    k/     i=l/2,3 


138 


-tc/2  <.  Ak fi  s  n/2      for  all  k,   i=l,2 

-7i  <,  Ak2  <.  n  for  all  k 

Xki   within  the  RANGE  coordinate  system  for  all  k,  i=l,2,3 

Xk3   >  0  (array  must  be  below  water)    for  all  k 
OBJECTIVE  FUNCTION: 

NX* 


MIN    EEM.J  +  HERi-J   +    (^k.jXPHEKk.j)2 
k   j=i 

for  all  k  with  NRk  =  6 
The  first  summation  in  the  objective  function  is  over  the 
set  of  index  k  which  yields  the  value  NRk  =6.  This  isolates 
the  problem  to  the  interior  arrays  only. 

Due  to  the  nature  of  underwater  ray  tracing,  the  objective 
function  and  constraints  are  nonconvex  and  nonlinear.  This 
environmental  nature  also  prevents  the  analytical  expression 
of  the  functions  f,  and  f2  (see  the  dynamic  programming 
solution  outlined  in  Ref  1) .  Without  the  analytical 
expressions  of  these  functions  the  gradients  are  also 
unavailable  in  analytical  form.  Based  on  the  above,  any 
algorithm  requiring  the  evaluation  of  the  gradient  would  be 
too  time  consuming  requiring  the  evaluation  of  the  functions 
to  obtain  the  gradients.  With  this  in  mind,  we  choose  an 
algorithm  that  does  not  require  the  evaluation  of  a  gradient. 
Among  the  algorithms  available  without  using  a  gradient  are 


139 


the  cyclic  coordinate  descent  algorithms.  These  algorithms 
allow  the  problem  structure  to  be  more  efficiently  exploited. 
A  simulated  annealing  algorithm  was  used  to  determine  the 
(global)  optimality  of  the  solution  provided  by  ERRFIX.  This 
algorithm  allowed  alternate  local  solutions  to  the  problem  to 
be  found.  Based  on  computational  experiments,  solutions  from 
simulated  annealing  were  only  marginally  better  than  those 
obtained  using  ERRFIX.  Thus  it  is  hypothesized  that  ERRFIX 
provides  a  nearly  global  optimal  solution.  Letting  ERRFIX 
perform  more  iterations  may  enhance  the  quality  of  the 
solution  produced. 
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